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ABSTRACT 


This  report  formulates  an  error  model  for  analyzing  a  cooperative  engagement  cruise 
missile  defense  scenario  in  which  a  surveillance  platform  transmits  the  location  of  a  target 
to  an  air  iiitcceptor  missile  only  once,  just  prior  to  launch.  Included  in  this  model  is 
a  description  of  the  three  relevant  inertial  navigation  systems  (aboard  the  surveillance 
platform,  the  launch  platform,  and  the  missile),  the  guidance  system  of  the  missile,  the 
surveillance  platform  radar,  and  the  motion  of  the  target.  Detailed  equations  for  each 
of  these  components  are  provided  along  with  numerical  values  for  the  error  parameters 
assumed  for  the  v^arious  instruments. 

This  report  is  the  second  volume  of  the  final  report  of  an  analysis  of  the  effectiveness 
of  a  U.S.  interceptor  long-range  defense  force  to  defend  against  the  cruise  missile  threat  in 
the  2005  time  frame,  conducted  by  SYNETICS  Corporation,  and  its  subcontractors.  Vitro 
Corporation  and  Veda  Inc.,  under  Contract  Number  DCA100-90-C-0031  with  the  Defense 
Communications  Agency.  Contract  effort  focused  on  two  related  issues:  formulation  of  the 
problem  to  permit  examination  of  advanced  surveillance  and  communication  technology 
potentially  defining  a  “cooperative  engagement”  concept,  and  a  bottoms-up  approach  to 
detailed  modeling  of  the  current  and  emerging  generation  of  air-to-air  missiles. 

The  other  volumes  of  this  report  include: 

Volume  I:  Problem  Definition,  Solution  Formulation,  Illustrative  Results  and  Recom¬ 
mendations 

Volume  II:  Error  Models  and  Simulation  Formulation  for  Case  I:  Pre-Launch  Coordi¬ 
nation  without  Post-Launch  Updates 

Volume  III:  Simulation  Tools:  Current  Status  and  Recommendations  for  Future  Devel¬ 
opment. 
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Chapter  1 

INTRODUCTION 


1.1  Background 

This  memo  contains  a  description  of  the  error  models  developed  for  Case  I  of  an  engage¬ 
ment  involving  four  entities: 

•  A  Target,  abbreviated  by  “T” 

•  A  Missile,  abbreviated  by  “M” 

•  A  Surveillance  Platform,  abbreviated  by  “SP” 

•  A  Launch  Platform,  abbreviated  by  ‘TP”. 

Case  I.  illustrated  in  Figure  1.1,  represents  the  simplest  cooperative  engagement  scenario 
under  consideration:  the  SP  transmits  the  location  of  T  to  M  only  once,  just  prior  to 
launch.  This  scenario  is  advantageous  because  after  launch  the  SP  can  devote  its  re- 
cniirces  t'^  tracking  other  targets  and  also  because  communications  equipment  aboard  M 
is  unnecessary  resulting  in  a  lighter  and  less  expensive  M. 

Other  scenarios  under  consideration  are: 

•  Case  II:  During  flyout  the  SP  tracks  T  and  transmits  the  location  estimates  to  M 
(possibly  through  the  LP).  This  case  requires  M  to  have  a  receiver  and  additional 
data  processing  equipment. 

•  Case  III:  Same  as  Case  II  but  in  addition  the  SP  tracks  M.  This  case  requires  M  to 
have  a  transponder. 

•  Case  IV:  Tracking  with  more  than  one  SP  operating  in  a  multistatic  mode.  This  con¬ 
figuration  is  particularly  effective  for  detecting  and  tracking  low-observable  targets 
([Foster.  1987]). 
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Figure  1.1;  Case  1  Scenario 

1.2  Organization 

This  memo  is  organized  into  three  parts: 

•  The  first  part  is  a  description  of  the  top-level  of  a  simulation  that  implements  the 
pre-launch  to  handover  error  model.  This  part  is  contained  in  Section  2. 

•  The  second  part  describes  each  of  the  components  of  the  top-level  model  at  a  qual¬ 
itative  (without  equations)  level.  This  part  is  contained  in  Section  3. 

•  The  third  part  provides  detailed  equations  for  each  of  the  components  described  in 
Section  3  including  numerical  values  for  the  errors  of  the  assumed  instruments.  This 
part  is  contained  in  .Appendix  A  (v’hich  makes  reference  to  derivations  contained  in 
•Appendix  B). 
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Chapter  2 

TOP-LEVEL  MODEL 

2.1  Model  Objective 

The  objective  of  the  model  developed  herein  is  to  compute  four  quantities: 

•  M  mean  position  and  velocity  at  handover 

•  T  mean  position  and  velocity  at  handover 

•  M  position  and  velocity  covariance  at  handover 

•  T  position  and  velocity  covariance  at  handover  . 

The  model  is  a  linearized  model  suitable  for  analysis  with  a  covariance  simulation  ([Gelb. 

1974]). 

The  procedure  followed  by  the  model  is  as  summarized  in  Figure  2.1; 

1.  The  mean  and  covariance  of  the  estimated  T  location  (position  and  velocity)  at 
launch  is  computed  based  on  the  measurements  provided  by  the  radar  and  INS  of 
the  SP 

2.  The  mean  and  covariance  of  the  predicted  T  location  at  handover  is  computed.  A 
sample  of  this  prediction  is  illustrated  by  the  straight-line  in  the  figure 

•3.  The  mean  and  covariance  of  the  estimated  M  location  at  launch  is  computed 

4.  From  items  2  and  3  an  acceleration  command  for  the  M  is  computed  so  that  an 
intercept  would  result  in  the  ab.sence  of  errors.  In  the  figure,  an  (erroneous)  predicted 
M  trajectory  is  illustrated  by  a  solid  curve,  whereas  the  resulting  M  trajectory  is 
illustrated  by  a  dashed  curve 

5.  From  item  4,  the  mean  and  covariance  of  the  M  location  at  handover  is  computed 

6.  Finally,  the  mean  and  covariance  of  the  T  location  at  handover  is  computed. 

This  sequence  of  steps  can  be  divided  into  three  top-level  steps:  the  first  two  steps 

are  pre- launch  initializations  while  the  third  step  simulates  the  launch  to  handover  flight. 

These  three  steps  are  described  in  the  subsections  that  follow. 


3 


Syngf/cs 


PREDICTED  KILL 


A-72S 


Figure  2.1:  Procedure  Overview 
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2.2  Step  1:  Compute  T  Location  Covariance 

Assumptions: 

•  The  SP  has  a  “better  quality”  platform  INS  ("better”  meaning  better  than  1  nm/hr) 
which  undergoes  a  ground  align  procedure  prior  to  takeoff 

•  The  SP  has  a  radar  that  measures  range,  azimuth,  elevation,  and  range-rate 

•  The  SP  is  travelling  in  a  constant  velocity  trajectory 

•  The  T  is  also  travelling  in  a  constant  velocity  trajectory  just  prior  to  launch. 
Inputs: 

•  SP  nominal  (deterministic)  position  and  velocity  at  launch 

•  T  nominal  position  and  velocity  at  launch 

•  RCSofT 

•  Error  model  for  the  INS  of  the  SP 

•  Error  model  for  the  radar  of  the  SP. 

Outputs:  The  output  of  Step  1  is  the  error  covariance  matrix  of  the  target’s  position 
and  velocity  at  the  moment  of  launch.  This  covariance  matrix  is  computed  based  on  the 
geometry  of  the  engagement  and  the  error  models  for  the  INS  and  the  radar  of  the  SP. 

Sequence  of  events  within  Step  1:  Figure  2.2  summarizes  the  following  sequence  of 
events: 


'NOOM  ' 


'2er  3  Hrs' 


INITIALIZATION 


^TIME 


OFP. 


spmt 


SP  INS 
SETTLED 


^lUOAR  WEAS  ^LAUNCH 


Figure  2.2:  Step  1  Timeline 
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1.  Set  Psp  INS  to  a  diagonal  matrix.  Psp  i.ns  is  the  covariance  matrix  of  a  local-level 
INS  (9  states  plus  error  sources). 

2.  Simulate  a  ground-align  procedure  by  solving  the  Riccatti  equation  for  Psp  lns  with 
measurements  of  position,  velocity,  and  heading  as  specified  in  the  ground-align 
model.  Ground  align  lasts  for  10  min. 

3.  Propagate  Psp  jms  for  2  or  3  hours  by  solving  the  Riccatti  equation  assuming  GPS 
fixes  every  10  sec  until  time  ^launch  —  Tno  gps^  where  Tno  gps  is  the  interval  of  time 
prior  to  launch  during  which  GPS  is  assumed  to  be  unavailable  (possibly  P^o  gps  = 
0). 

4.  If  Pnogps  ^  0,  propagate  Psp  ins  to  /launch  without  GPS  fixes. 

5.  Set  the  tracking  filter  covariance  matrix,  Psp track(/radar  meas)  oqual  to  a  block- 
diagonal  matrix  with  two  blocks:  Psp  ins(/radar  meas)  and  Ptarget (/radar  meas) 
where  /radar  meas  =  /launch  —  with  S  a  small  number,  is  the  time  at  which  the 
radar  measurement  is  taken  just  prior  to  launch.  Ptarget  (/radar  meas)  i®  ®^t  to  a 
large  diagonal  matrix. 

6.  Perform  one  optimal  update  on  Psp  track  modeling  one  radar  measurement  (which 
may  represent  several  measurements).  Alternatively,  tracking  over  a  period  of  time 
may  be  modeled  by  performing  a  number  of  optimal  propagates  and  updates. 

7.  Do  a  CPC^  transformation  on  Psp  track  In  obtain  the  covariance  matrix  of  the 
target  position  and  velocity  at  launch,  Ptarget(/launch)- 

Model  Components:  Step  1  requires  three  component  error  models: 

•  SP  INS^  model  (described  in  Subsection  3.S) 

•  Ground  align  model  (described  in  Subsection  3.5) 

•  T  motion  model  (described  in  Subsection  3.1) 

•  SP  radar  measurement  model  (described  in  Subsection  3.9). 

2.3  Step  2;  Initialization  of  the  M  INS 

Assumptions:  The  LP  is  assumed  to  have  a  1  nm/hr  strapdown  INS  and  the  M  is  assumed 
to  have  also  a  strapdown  INS  of  somewhat  worse  quality. 

Inputs: 

•  LP  nominal  (deterministic)  trajectory  prior  to  launch 

•  Error  models  for  the  INS  of  the  LP 

'a  full-order  model  is  used  for  the  INS  in  this  step  because  (1)  the  covariance  is  propagated  for  many 
Schuler  periods  and  (2)  the  step  is  run  by  itself  so  that  plenty  of  RAM  is  available. 


6 


Synctlcs 


•  Error  models  for  the  INS  of  the  M 

•  Separation  (lever  arm)  between  the  LP  and  M  INS. 

Outputs:  The  output  of  Step  2  is  the  error  covariance  matrix  of  the  M  INS  model  at 
the  time  of  launch.  This  covariance  matrix  is  computed  based  on  the  error  models  ^or  (1) 
the  INS  of  the  LP  and  (2)  the  INS  of  the  M. 

Sequence  of  Steps  within  Step  2:  The  objective  of  Step  2  is  to  simulate  a  transfer 
alignment  of  the  M  INS.  This  simulation  requires  the  simultaneous  propagation  prior  to 
launch  of  (1)  the  INS  aboard  the  LP  and  (2)  the  INS  aboard  the  .M. 

Ti.'e  propagation  of  the  INS  aboard  the  LP  proceeds  as  summarized  by  the  timeline 
shown  in  Figure  2.3: 


a 

- 2  or  3  Hrs - ► 

INITIAUZATION  LPINS  tBEQNTA  *ENDTA 

OFPLpffo  SETTLED 


- [-►TIME 

ii 

^LAUNCH 


Figure  2.3:  Step  2  Timeline 


1.  Set  Plpins  to  a  diagonal  matrix.  Plp  ins  is  the  covariance  matrix  of  a  strapdown 
INS  (9  states  plus  error  sources). 

2.  Simulate  a  ground-align  procedure  by  solving  the  Riccatti  equation  for  Ptp  ins  with 
measurements  of  position,  velocity,  and  heading  as  specified  in  the  ground-align 
model.  Ground  align  lasts  for  10  min. 

3.  Propagate  Plp  ins  for  2  or  3  hours  by  solving  the  Riccatti  equation  assuming  GPS 
fixes  every  10  sec  up  until  time  ^launch  —  Pnogps-  This  propagation  depends  on 
the  trajectory  assumed  for  the  LP  as  discussed  below. 

1.  If  Tnogps  i-  0-  propagate  Ppp  ins  to  /launch  without  GPS  fixes. 

The  timeline  for  the  propagation  of  the  INS  aboard  the  M.  also  summarized  in  Fig¬ 
ure  2.3,  proceeds  eis  follows: 
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1 .  Set  Pm  ins  to  a  diagonal  matrix  and  simulate  a  ground-align  analogous  to  that  of 
the  SP  and  LP.  Pm  ins  is  the  covariance  matrix  of  a  strapdown  INS  (9  states  plus 
error  sources). 

2.  Propagate  Pm  ins  open-loop  for  2  or  3  hours  until  the  INS  settles 

3.  Perform  the  transfer  alignment  during  the  interval  tsECiN  ta  £  t  <  ^endta-  During 
this  interval; 

•  The  LP  performs  an  S-maneuver 

•  The  Riccatti  equation  for  the  covariance  of  the  concatenated  M  INS  state  and 
LP  INS  state  is  propagated  with  measurement  of  the  difference  in  the  output 
of  the  measurements  provided  by  both  INSs  (taking  into  account  the  lever  arm 
effect). 

4.  Set  Pm  ins(^end  ta)  to  the  final  covariance  matrix  computed  from  the  Riccatti  equa¬ 
tion. 

5.  Propagate  Pm  ins  open-loop  to  ^launch-  Note  that  the  beneficial  effect  of  the  trans¬ 
fer  alignment  is  diminished  if  the  M  in  question  is  launched  a  long  Lime  after  the 
transfer  alignment  (i.e.,  the  length  of  the  time  interval  ^launch  “  ^endta  is  a  pa¬ 
rameter  of  the  engagement). 

6.  Initialize  the  covariance  matrix  for  the  M  INS.^ 

Model  Components:  Step  2  requires  three  component  error  models: 

•  LP  INS,  model  (described  in  Subsection  3.11) 

•  M  INS,  model  (described  in  Subsection  3.4) 

•  LP  deterministic  trajectory  model  (described  in  Subsection  3.3). 

2.4  Step  3:  Launch  to  Handover  Simulation 

Assumptions: 

•  The  transfer  function  of  the  M  autopilot  has  no  lags 
Inputs: 

•  Acquisition  range  of  M  seeker  (determines  when  the  flyout  ends) 

•  Parameters  for  the  random  T  motion  Singer  model 

•  Parameters  for  the  random  M  motion  Singer  model 

^Instead  of  a  full-order  covariance,  a  reduced-order  covariance  can  be  used  if  necessary  to  accommodate 
the  DOS  640K  RAM  limit.  The  reduced-oider  covariance  can  be  then  propagated  during  flyout  using  a 
reduced-order  model  for  the  M  INS. 
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•  Error  models  for  the  M  INS 

•  T  and  M  nominal  (deterministic)  position  and  volocity  at  launch 

•  Covariance  of  T  location  at  launch  (from  Step  1) 

•  Covariance  of  M  INS  model  at  launch  (from  Step  2) 

Outputs:  The  output  of  Step  3  is  the  mean  and  covariance  of  the  M  and  T  position 
and  velocity  at  the  end  of  flyout. 

Sequence  of  Steps  within  Step  3:  The  following  two  steps  are  executed: 

1.  Compute  mean  and  covariance  of  M-acceleration  command.  The  acceleration  com¬ 
mand  is  computed  from  the  (erroneous)  position  and  velocity  estimates  of  M  and 
T  so  that  an  intercept  is  produced  if  (1)  M  and  T  do  not  maneuver  during  the 
endgame  and  (2)  all  estimates  are  error-free. 

2.  Propagate: 

•  T  position  and  velocity  (from  the  Singer  model  and  the  nominal  trajectory) 

•  M  INS  (from  the  INS  model  and  the  mean  acceleration  command) 

•  M  position  and  velocity  (from  the  Singer  model  and  the  commanded  accelera¬ 
tion  vector  pointed  in  the  erroneous  direction  indicated  by  the  M  INS). 

This  procedure  is  summarized  in  Figure  2.4. 

Model  Components:  Step  3  requires  four  component  error  models: 

•  T  random  motion  (Singer)  model  (described  in  Subsection  3.1) 

•  M  random  motion  (Singer)  model  (described  in  Subsection  3.2) 

•  M  INS  model  (described  in  Subsection  3.4) 

•  M  mid-course  guidance  model  (described  in  Subsection  3.7). 
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Chapter  3 

COMPONENT  MODELS 


This  section  provides  an  overview  of  the  thirteen  component  models  recpiircd  in  the  sim¬ 
ulation  of  Case  I: 

•  T: 

-  T  motion  model  (Subsection  3.1) 

•  M; 

-  M  random  motion  model  (Subsection  3.2) 

-  M  INS  model  (Subsection  3.1) 

-  M  ground  align  (Subsection  3.5) 

-  M  transfer  align  (Subsection  3.6) 

-  M  mid-course  guidance  model  (Sub.section  3.7) 

•  SP: 

-  SP  INS  model  (Subsection  3.8) 

-  SP  ground  align  (Subsection  3.5) 

-  SP  radar  model  (Subsection  3.9) 

—  SP  tracking  filter  model  (Subsection  3.10) 

•  LP: 

-  LP  deterministic  trajectory  model  (Subsection  3.3) 

-  LP  INS  model  (Subsection  3.11) 

-  LP  ground  align  (Subsection  3.5) 
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3.1  T  Motion  Model 

riie  T  mctioii  model  is  composed  of  two  componerts;  a  nominal  (deterministic)  trajec¬ 
tory  which  is  an  input  to  the  simulation;  and  a  random  component  which  models  small 
deviations  from  the  nominal  trajectory.  The  deviations  of  ^he  random  component  are  a 
result  of  wind,  turbulence,  and  random  motion  introduced  by  the  guidance  mechanism 
of  the  T.  These  random  deviations  are  unpredictable  and  consequently  contribute  to  the 
miss  distance. 

The  random  component  is  modeled  by  a  Singer  model  ([Singer.  1969]).  The  Singer 
equations  characterize  acceleration  as  a  band-limited  random  process  with  the  bandwidth 
and  power  based  on  tiie  anticipated  motion  of  the  target.  The  state  variables  of  the  Singer 
model  are  listed  in  Table  d.l  (position,  velocity,  and  acceleration  along  the  x-,  y-,  and 
r-axes).  Subsection  .A.l  of  .Appendix  .\  gives  the  d«>tailed  ecpiations  for  the  Singer  model 
as  well  as  the  efiuations  used  in  computing  the  power  of  the  acceleration  process. 


Table  :l.l:  ST.ATE  \  ARI.ABLKS  OF  T.AHGFT  MOTION  .MODEL 


SYMBOL 

DEFI.NITION 

PTr 

x-position 

"Tz 

x-velocity 

flTz 

x-acceleration 

PTy 

t/-position 

'Ty 

y-velority 

<ny 

(/-afcelcTaiion 

PTz 

posit  ion 

'  r.- 

r-\  locity 

'‘T-' 

^-acceleration 

3.2  M  Random  Motion  Model 

M  motion  is  the  sum  of  two  components:  motion  resulting  from  the  guidance  cv..nmand 
(considered  in  Subsection  9.7);  and  an  uncontrollable  perturbation  resulting  mom  random 
effects  analogous  to  those  in  the  T  Motion  Model.  Both  of  these  components  affect  miss 
distance. 

I  he  uncontrollable  perturbations  are  modeled  by  a  Singer  models  with  state  variables 
as  listed  in  Table  9.2.  The  ecpiations  describing  this  model  are  addressed  in  Subsection  A.z 
of  Appendix  A. 

3.3  LP  Deterministic  Trajectory  Model 

The  LP  is  assumed  to  follow  a  deterministic  trajectory  which  affects  the  geometry  o'"  the 
engagement  The  detailed  shape  /  this  trajectory  is  also  important  because  uLe  error 
statistics  of  the  LP  L\S  and  the  .\’  INS  prior  to  launch  are  a  function  of  the  acceleration 
and  angular  rates  (producecl  by  roll,  pitch,  and  yaw  motions)  experienced  by  the  LP. 
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SYMBOL 

DE  FL\iTIOi\ 

P\fT 

r-position 

j--veiorit  V 

(l\tT 

j’-acceleration 

PMy 

V- position 

f  ■ 

y-velocity 

«  Vfy 

i/-ai-celeration 

PMz 

r-position 

‘  .\/ 

r-velocity 

"  \f 

;-acr('leration 

The  motion  of  the  LP  is  assumed  to  lie  a  se(|uenee  of  events  chosen  from  the  following 
menu; 

•  Level  flight  at  constant  velocity 

•  Right- 1  urn  /  Left-turn  to  a  given  heading 

•  Climb  to  a  given  altitude 

•  Descent  to  a  given  altitude 

•  Speed-up  alotig  a  constant  altitude 

•  Azimuth  change  while  on  the  ground. 

For  ea'h  of  these  events,  the  variables  listed  in  Table  3.3  are  computed.  These  variables 
specify  the  relevant  aspects  of  the  motion  of  the  LP  (and  the  M)  from  the  time  of  ground 
align,  [trior  to  take-off.  to  the  time  of  .M  launch 

.•\  detaih'd  description  of  the  LP  motion  « vents  and  the  algorithms  required  for  the 
com[)utation  of  the  motion  variables  is  provided  in  Section  A. 3  of  Appendix  A. 


3.4  M  INS  Model 

The  .M  is  assumed  to  have  a  strapdown  INS.  The  INS  errors  are  characterized  by  a  state 
vector  having  six  groups  of  entries  as  shown  in  Table  3.4: 

•  Errors  in  attitude  (body  to  local-level  angles) 

•  Errors  in  latitude,  longitude,  and  allifiide  rates 

•  Errors  in  latitude,  longitude,  and  altitude 

•  CIvTO  drift  rate  errors 
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[able  I  P  DKTPRMIMSTIC  TRAJECTORY  MOTION  VARIABLES 


MOriON  VAHIAULK 

RELATIVE  TO 

REQUIRED  FOR: 

Posit  lOII 

Rotating  Earth 

•  Trajectory  specification 

W'locit  y 

tt 

•  Guidance  computations 

Acceleration 

n 

Acceleration 

Inertial  space 

•  INS  error  dynamics 

•  Accelerometer  scale  factor  errors 

Lalilinie 

The  Equator 

•  INS  error  dynamics 

Lonfiit  iiiie 

Vernal  Equino.'c 

Longitude 

(iJreenwich 

.Altitude 

Reference  Ellipsoid 

Lat..  I.on  ,  ,Mt  rate.s 

Lat..  Lon.  accelerations 

— 

Bank  angle 

— 

•  I. NS  error  dynamics 

Elevation  angle 

— 

■Vzimuth 

Boll  rale 

Inertial  space 

•  Gyro  scale  factor  errors 

Pitch  rate 

n 

•  Transfer  alignment  model 

\'aw  rate 

n 

•  Altirnetor  errors. 

T^'P  state  ('quations  for  these  errors  arc  provided  in  Subsection  A. 4  of  Appendix  A. 

t  INS  Reduced-Order  Model  Because  flyout  icists  for  only  a  few  minutes,  the  error 
equations  given  in  the  previous  subsection  can  be  approximated  by  a  reduced-order  model. 
This  model  approximates  the  error  by  polynomials  in  time  with  coefficients  determined 
by  error  source  models  valid  over  short  time  intervals.  Different  polynomials  are  used  for 
different  trajectory  segments. 

Currently  a  reduced-order  model  appears  to  be  unnecessary  because  a  suitable  soft¬ 
ware  development  environment  which  bypasses  the  DOS  640K  RAM  limit  is  available. 
Consequently  a  more  detailed  description  of  this  model  is  not  provided. 


3.5  M,  LP,  and  SP  Ground  Align  Model 

The  ground  align  procedure  has  three  ol)jectives:  to  level,  align,  and  calibrate  the  INS.  The 
first  two  objectives  determine  the  relationship  between  the  platform  frame  and  the  frame 
where  navigation  computations  (double  integration  of  acceleration)  are  performed.  For 
an  INS  with  a  local-level  platform  (such  as  that  of  the  SP),  leveling  involves  orienting  the 
platform  so  that  it  is  perpendicular  to  the  gravity  vector  (North  and  East  accelerometers 
read  zero)  and  rotating  the  platform  until  it  points  North  (gyrocompassing,  [Farrell, 
1976]).  For  a  strapdown  INS  (such  as  those  of  the  ,M  and  LP),  leveling  and  alignment  is 
implemented  within  the  computer  by  initializing  estimates  of  the  INS  state  and  associated 
transformations  ([Farrell,  1976]). 

The  third  objective  of  the  ground  align  procedure  is  to  calibrate  (estimate)  the  gyro 
and  accelerometer  bias.  This  bias  is  often  calle<l  the  “repeatability"  or  “turn-on"  bias 
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Table  3.4;  STATE  VARIABLES  OF  M  INS  MODEL 


SYMBOL 

DEFINITION 

Attitude  Error  About  N  Axis 

Attitude  Error  About  E  Axis 

Attitude  Error  About  D  Axis 

SLm 

Latitude  Rate  Error 

Longitude  Rate  Error 

Sh\i 

Altitude  Rate  Error 

dL\i 

Latitude  Error 

Longitude  Error 

fih^ 

Altitude  Error 

Im 

Gyro  Error  Source  Vector 

tlM 

Accelerometer  Error  Source  Vector 

Altimeter  Error 

because  a  different  value  is  obtained  every  time  the  INS  is  activated. 

The  ground  align  procedure  is  modeled  here  by  assuming  an  initial  covariance  matrix 
for  the  INS  state  and  simulating  Kalman  filter  updates  derived  from  position,  velocity, 
and  magnetic  heading  measurements  on  a  stationary  aircraft.  Details  of  the  ground  align 
model  are  provided  in  Subsection  A. 7  of  Appendix  A. 


3.6  M  Transfer  Align  Model 

The  objective  of  the  transfer-align  procedure  is  to  calibrate  (i.e..  estimate  and  correct) 
errors  in  the  M  INS  by  comparing  its  read-out  with  that  of  the  more  accurate  LP  INS. 
The  errors  that  are  calibrated  fall  into  two  categories:  (1)  instrument  errors  (specifically 
gyro  and  accelerometer  errors);  and  (2)  system  errors  (specifically  errors  in  the  M  INS 
estimates  of  where  the  North  and  Down  directions  are).  This  procedure  is  performed 
in-flight  and  as  near  to  the  time  of  launch  as  possible  because  the  beneficial  effect  of  the 
transfer-alignment  (the  reduction  of  the  error  covariance  of  the  state  of  the  M  INS)  decays 
with  time.  Details  of  the  transfer-align  model  are  provided  in  Subsection  A. 8 


3.7  M  Mid-Course  Guidance  Model 

The  guidance  model  describes  the  propagation  errors  through  three  cascaded  “maps” 
(indicated  by  “ - >”): 

1.  Current  estimated  position  and  velocity  of  M  and  T  — >  Commanded  (computed) 
acceleration.  This  map  is  the  “guidance  law." 
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2.  Commanded  acceleration  — >  Resulting  M  acceleration.  This  map,  which  models 
the  autopilot,  includes  the  effect  of  the  misalignment  of  the  M  INS. 

.3.  Resulting  M  acceleration  — >  Resulting  M  velocity  — y  Resulting  M  position.  This 
map  is  modeled  by  two  integrations  which  represent  Newton's  second  law. 

The  state  variables  of  the  M  Mid-Course  Guidance  Model  are  listed  in  Table  3.5.  The 
table  shows  five  groups  of  variables: 

•  The  state  error  vector  of  the  M  INS, 

•  Errors  in  the  position  and  velocity  read-out  of  the  M  INS  (computed  from  x^f) 

•  Errors  in  the  position  and  velocity  estimates  of  the  T  position  (computed  from  the 
tracking  filter  model  discussed  in  Section  3.10) 

•  Errors  in  the  computed  guidance  quantities  (accelerations  and  duration  of  applied 
accelerations)  due  to  the  preceding  two  groups  (i.e.,  due  to  Sp\f,  Sv\f,  Sp^-,  and  Sv^) 

•  Errors  in  the  resulting  M  acceleration  arising  from  the  misorientation  of  the  M  INS 
(computed  from  x_i^)- 

State  equations  for  these  errors  ?:e  provided  in  Subsection  A. 9  of  Appendix  A. 

Table  3.5:  STATE  VARIABLES  OF  MISSILE  MID-COURSE  GUIDANCE  MODEL, 


SYMBOL* 

DEFINITION 

M  INS  state  error  vector  (Table  3.4) 

Error  in  M  INS  position  read-out 

Error  in  M  INS  velocity  read-out 

bplj- 

Error  in  T  position  estimate  from  the  SP  tracking  filter 

b  Vy-p 

Error  in  T  velocity  estimate  from  the  SP  tracking  filter 

f’Ta.c 

Error  in  the  computed  duration  of  applied  acceleration 

Error  in  the  computed  level  (North/East)  acceleration 

Error  in  the  computed  vertical  (down)  acceleration 

Error  produced  by  the  drift  of  the  M  INS  during  flyout 

‘The  subscript  t  in'^i 


ates  that  the  vector  is  expressed  in  the  tangential  frame  define  on  page  24. 
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3.8  SP  INS  Model 

The  SP  INS  model  differs  in  two  respects  from  the  M  INS  model  described  in  Snbser- 
tion  3.1: 

•  A  local-level  platform  INS  is  modeled  instead  of  a  strapdown  INS 

•  The  quality  of  the  instruments  is  superior  to  those  of  the  M  INS. 

Both  of  these  factor  affect  only  the  forcing  function  (right-hand  side)  of  the  differential 
error  equations  ([Britting,  1971]).  Consequently  the  state  variables  f^r  the  SP  INS  model, 
listed  in  Table  3.6,  are  analogous  to  those  of  the  M  INS  (listed  in  Table  3.4). 


Table  3.6:  STATE  VARIABLES  OF  SP  INS  MODEL 


SYMBOL 

DEFINITION 

Attitude  Error  About  N  Axis 

Attitude  Error  About  E  Axis 

Attitude  Error  About  D  Axis 

6Ls 

Latitude  Rate  Error 

sis 

Longitude  Rate  Error 

Shs 

Altitude  Rate  Error 

SLs 

Latitude  Error 

f'tS 

Longitude  Error 

Shs 

Altitude  Error 

£s 

Gyro  Error  Source  Vector 

«s 

Accelerometer  Error  Source  Vector 

ShsA 

AIM  meter  Error 

The  state  equations  for  the  SP  INS  errors  are  included  in  Subsection  A. 6  of  Appendix 
A. 

3.9  SP  Radar  Model 

Radar  measurement  errors  are  assumed  to  be  modeled  by  an  uncorrelated  sequence  wuth 
covariance  computed  from  the  radar  equation.  Consequently,  state  variables  are  unnec¬ 
essary  for  modeling  the  radar  errors. 

The  equations  for  computing  the  measurement  error  covariance  (R-matrix)  are  pro¬ 
vided  in  Subsection  A.  10  of  Appendix  A. 
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3.10  SP  Tracking  Filter  Model 

The  SP  tracking  filter  is  a  nominal-trajectory  linearized  Kalman  filter.  The  i?-matrix  for 
this  filter  is  specified  by  the  SP  Radar  Model  discussed  in  the  previous  section.  The  state 
equations  are  divided  into  three  groups  as  indicated  in  Table  .3.7; 

•  The  crisis  in  the  estimates  oi  the  position,  velocity,  and  azimuth  of  the  ST  as 
indicated  by  the  SP  INS 

•  The  states  of  the  random  component  of  target  motion. 

•  A  group  of  position  and  velocity  biases  modeling  the  a  priori  uncertainty.  The 
covariance  of  these  states  is  large  before  the  radar  measurement  is  processed. 


Table  3.7:  STATE  VARIABLES  OF  SP  TRACKING  FILTER 


SYMBOL 

DEFINITION 

^PSP 

Position  Error  from  SP  INS  Model  (Table  3.6) 

6vsp 

Velocity  Error  from  SP  INS  Model 

iOsP.az 

Azimuth  Error  from  SP  INS  Model 

£t 

T  Motion  Model  in  Table  3.1 

^PTx  bias 

Bias  Error  in  T  x-Position 

BIAS 

Bias  Error  in  T  x- Velocity 

SpTy  BIAS 

Bias  Error  in  T  y-Position 

BIAS 

Bias  Error  in  T  y- Velocity 

<5PTZ  BIAS 

Bias  Error  in  T  c- Position 

BIAS 

Bias  Error  in  T  c- Velocity 

The  state  equation  for  the  tracking  filter  are  provided  in  Subsection  A. 11  of  Appendix 
A. 

3.11  LP  INS  Model 

The  state  variable  and  equations  of  the  LP  INS  error  model  are  identical  to  those  of 
the  T  INS  (Subsection  3.4)  except  for  the  instrument  error  models  which  correspond  to 
better-quality  instruments.  The  state  variables  are  listed  in  Table  3.8  and  the  equations 
are  provided  in  Subsection  A. 5  of  Appendix  A. 
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Table  3.8:  STATE  VARIABLES  OF  LP  INS  MODEL 


SYMBOL 

DEFINITION 

Attitude  Error  About  N  Axis 

HIM 

Attitude  Error  About  E  Axis 

■  SB 

Attitude  Error  About  D  Axis 

6Ll 

Latitude  Rate  Error 

Longitude  Rate  Error 

6/il 

Altitude  Rate  Error 

Latitude  Error 

Longitude  Error 

Altitude  Error 

Gyro  Error  Source  Vector 

o 

Accelerometer  Error  Source  Vector 

Altimeter  Error 
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Appendix  A 

DETAILED  COMPONENT 
MODEL 


This  appendix  provides  detailed  equations  for  each  of  the  component  models  described  in 
Section  2. 

A.l  T  Motion  Model 

The  T  motion  model  is  composed  of  two  components:  deterministic  and  random.  These 
two  components  are  described  in  Subsections  A. 1.1  and  A. 1.2. 

A. 1.1  T  Deterministic  Motion  Model 

The  deterministic  motion  of  the  T  is  approximated  by  polynomials  in  the  x-,  y-,  and  2- 
axes  of  the  tangential  frame  defined  in  Section  A. 3.  Motion  in  the  x-direction  is  specified 
in  the  interval  <t  <  by 

P7'i,det(0  —  PTx.det.i  T  ^’Tr.det.t(^  ^i)  T  ^®Ti,det,i(^  )  5  (^T) 

and  similarly  for  the  y-  and  2-axes.  Consequently,  the  deterministic  motion  of  the  target 
is  specified  by  an  array  of  the  form  shown  in  Table  A.l.  For  most  cases  the  acceleration 
term  in  Equation  A.l  is  set  to  zero  to  obtain  a  piece-wise  linear  T  trajectory. 

A.  1.2  T  Random  Motion  Model 

The  random  component  of  the  T  Motion  Model  is  composed  of  three  Singer  models  which 
specify  motion  along  each  of  the  three  axes  of  the  tangential  frame  defined  in  Section  A. 3. 
The  model  corresponding  to  the  x-axis  is  given  by  state-space  equations  of  the  form 
([Gelb,  1974]) 

^Tx  =  E.Tx1.Tx  +  ^Tx  ■  (A. 2) 
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Table  A.l;  T  DETERMINISTIC  MODEL  INPUT  TABLE 


j-MOTION 

COEFFICIENTS 

y-MOTION 

COEFFICIENTS 

r-MOTION 

COEFFICIENTS 

u 

1 

PTr, det.ii  PTx,det,ii  PTx, det.ii 

- 

det.it  *’Tr.det,it  ^Tx.det,* 

^Tr,det,i)  *^Tr,det,it  *^Tx,det,i 

The  F-matrix,  the  white  noise  vector,  and  its  spectral  matrix  ([Gelb,  1974])  are  given  by 
([Singer,  1969]) 


£tx 


'01  0 

0  0  1 

0  0  — O-Tr 


(A.3) 


W.TX 


0 

0 

WTx 


(A.4) 


0  0  0 
0  0  0 
0  0  qxx 


(A.5) 


These  equations  indicate  that  acceleration,  velocity,  and  position  are  related  by  integra¬ 
tions,  and  that  acceleration  is  taken  as  a  first-order  Markov  process.  Analogous  models 
are  formulated  for  the  random  motion  along  the  y  and  s  coordinates. 

The  Singer  model  is  a  function  of  two  parameters:  ajx  and  ctj^.  These  parameters 
are  set  as  follows  ([Singer,  1969]).  The  parameter  o  is  the  reciprocal  of  the  correlation 
time  r. 


(A.6) 


The  correlation  time  is  initially  set  to 


r  =  .5  sec. 


(A.7) 


This  value  may  be  considered  representative  of  turbulence  and  autopilot  maneuvers. 

The  power  parameter,  <Tj_,  is  set  based  on  the  anticipated  magnitude  of  the  maneuvers 
according  to  the  formula 

4x  =  %'11+4F„.,-Fo].  (A.8) 

In  this  equation, 

Pq  =  Probability  that  the  acceleration  is  zero 
Amax  =  Maximum  expected  acceleration 
Pmax  =  Probability  that  the  acceleration  is  Amax- 
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Equation  A. 8  is  derived  in  [Singer,  1969]  by  assuming  a  uniform  probability  density  func¬ 
tion  for  acceleration  with  spikes  at  zero  and  ±.4n,ax-  The  power  parameter  specifies  the 
spectral  density  of  the  white  noise  wtj., 

qxx  —  (A. 9) 


by 


The  covariance  of  the  random  component  of  T  motion  ("‘Singer  covariance’’)  is  defined 


^Tx(^) 

2lTr(0 

PrAi)  =  E[ 

ilTylO 

£ry(0 

.  iLTzit)  . 

(A.IO) 


The  subscript  L  in  P.j  i{t)  indicates  that  this  covariance  is  a  location  covariance  as  op¬ 
posed  to  an  estimation  covariance. 


A. 2  M  Random  Motion  Model 

The  random  component  of  the  M  motion  is  also  given  by  x-,  y-,  and  ^-Singer  models,  each 
model  characterized  by  equations  analogous  to  Equations  A. 2  to  A. 4.  The  parameters  for 
the  Singer  models  (qtx  and  are  set  by  the  procedure  described  in  Subsection  A.l. 
The  covariance  of  the  random  component  of  M  motion  (“Singer  covariance’’)  is  similarly 
defined  as 

PM.Lit)  =  E{ 

The  deterministic  component  of  the  M  motion  is  given  in  Section  A. 9  which  addresses 
the  guidance  model. 

A. 3  LP  Deterministic  Trajectory  Model 

A. 3.1  Introduction 

The  notation  used  in  describing  the  LP  trajectory  model  is  as  follows: 

•  Superscripts  indicate  Cartesian  reference  frames.  Five  frames  are  of  interest: 

-  The  “inertial"  frame  (z-frame),  having  its  origin  at  the  center  of  the  Earth, 
x-axis  pointing  to  the  vernal  equinox  and  the  2-axis  pointing  to  the  North  pole 

-  The  Earth-centered  Earth-fixed  frame  (e-frame),  having  its  origin  at  the  cen¬ 
ter  of  the  Earth,  x-axis  on  the  Equatorial  plane  and  through  the  Greenwich 
meridian,  and  the  x-axis  pointing  to  the  North  pole 

-  The  geographic  frame  (n-frame),  having  its  origin  at  the  center  of  mass  of  the 
vehicle  (LP),  x-axis  pointing  North,  y-axis  East,  and  x-axis  down 


Uixit)  ' 

^Mx{l) 

y  (  0 

iMy(0 

(ATI) 


23 


Synotks 


-  The  tangential  frame  (Tfranie),  a  geographic  frame  with  origin  at  a  fixed  lo¬ 
cation  relative  to  the  Earth.  The  location  of  the  origin  is  determined  by  its 
latitude,  longitude,  and  altitude.  (//o,TAN,^o,TAN,/io,fAN),  which  are  simula¬ 
tion  inputs.  Values  for  these  three  coordinates  sliould  be  chosen  to  specify  a 
location  near  the  launch  point 

—  The  body  frame  (feframe),  having  its  origin  at  the  center  of  mass  of  the  vehicle, 
.r-frame  along  the  roll  axis,  y-frame  along  the  pitch  axis,  and  z  along  the  yaw 
axis. 


•  is  the  direction  cosine  matrix  (DCM)  for  transforming  a  vector  in  the  6-frame 
to  one  in  the  n-frame  ([Britting,  1971]).  A  similar  notation  is  used  for  other  DCM 
transformations  with  the  exception  of  the  roll,  pitch,  and  azimuth  (yaw)  transfor¬ 
mation  matrices  ([Etkin,  1972]): 


Lr{0)  - 

1,(6)  = 

LaW  = 

where  4),  6,  and  0  are  roll 
•  Time  (0  is  GMT. 


■  1  0  O' 

0  cos  <p  sin  (j) 

0  —  sin  0  cos  0 

cos  0  0  —  sin  6 

0  1  0 

_  sin0  0  cos  6 

costf  sin0  0 
—  sin0  costp  0 
0  0  1 

pitch,  and  azimuth  angles. 


(roll) 

(A.12) 

(pitch) 

(A.13) 

(azimuth) 

(A.14) 

This  section  contains  the  algorithms  for  computing  thirty-one  deterministic  (non- 
random)  motion  variables  for  each  of  six  possible  LP  motion  events.  The  thirty-one 
variables  are  listed  in  Table  A. 2  which  also  specifies  the  frame  in  which  the  variable 
is  expressed  and  the  corresponding  symbol.  These  variables  are  necessary  for  specifying 
the  propagation  of  INS  errors  as  summarized  in  Table  3.3. 

The  six  LP  motion  events  are  considered  in  the  following  subsections  as  follows: 

•  Level  flight  at  constant  velocity:  Subsection  A. 3. 3 

•  Right-turn  /  Left-turn  to  a  given  heading;  Subsection  A. 3. 4 

•  Climb  /  descent  to  a  given  altitude:  Subsection  A. 3. 5 

•  Change  of  speed  at  a  constant  altitude;  Subsection  A. 3. 6 

•  Azimuth  change  while  on  the  ground:  Subsection  A. 3. 7. 

In  addition  to  these  motion  events,  two  additional  events  are  considered: 
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Table  A. 2:  LP  TRAJECTORY  MOTION  VARIABLES  AND  SYMBOLS 


MOTION  VARIABLE 

RELATIVE  TO 

FRAME 

SYMBOL 

Position 

Rotating  Earth 

Tangential 

P^LP 

Velocity 

n 

ft 

Acceleration 

n 

ft 

Specific  Force 

Inertial  space 

Geographic,  Body 

Latitude 

The  Equator 

— 

Llp 

Celestial  Longitude 

Vernal  Equino-x 

— 

^LP 

Terrestrial  Longitude 

Greenwich 

— 

hp 

Altitude 

Reference  Ellipsoid 

— 

hip 

Rates 

— 

— 

Llp,  ^LP,  (lp,  Llp 

Accelerations 

— 

— 

Llp,  ^lp,  (lp 

Bank 

( Euler  angle) 

— 

0 

Elevation 

ft 

— 

e 

Azimuth 

ft 

— 

>1' 

Roll  rate 

Inertial  space 

Body 

p 

Pitch  rate 

// 

ft 

<1 

Yaw  rate 

" 

// 

r 

•  A  one-time  initialization  is  performed  at  the  beginning  of  the  simulation,  described 
in  the  following  subsection  (Subsection  A.3.2) 

•  A  trajectory  with  constant  three-dimensional  acceleration.  This  trajectory,  neces¬ 
sary  for  the  propagation  of  the  M  INS  dynamics  considered  in  Subsection  A. 9. 9,  is 
described  in  Subsection  A. 3. 8. 

A.3.2  Initialization 

.Assumptions  —  The  model  for  the  initial  condition  of  the  LP  is  based  on  the  following 
assumptions: 

•  At  the  initial  time.  tLP.iNix: 

-  the  LP  is  stationary  at  a  known  (BASE)  location  and  oriented  at  a  known 
azimuth 

-  Pitch  and  roll  angles  are  zero 

•  After  tLp.iNiT- 

-  Ground  align  is  performed 

-  The  LP  takes  off  by  executing,  as  required,  a  combination  of:  azimuth  change 
while  on  the  ground  (Subsection  A. 3. 7);  change  of  speed  (Subsection  .A. 3.6); 
and  climb  (Subsection  A. 3. 5). 

Input  Parameters  —  The  initial  conditions  for  the  LP  are  determined  by  the  following 
input  parameters: 
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•  Initial  time,  /ummt 

•  Initial  LP  location,  ( /-basEi  ^BASfc;' 1 

•  Initial  azimuth  t'np.iNir- 

(’ornpntation  Alsorithm  -  The  objective  ol"  the  computation  algorithm  is  to  provide 
initial  values  for  tlie  variables  listed  in  Tabh'  A. 2.  A  four-step  procedure  is  followed. 

/.  Computation  of  point  moss  t-frnmr  location  (p\  p,  uip.  a^ip)  at  tLP.l.MT-' 
la.  Velocitv  and  .\cceleration; 


>’Lp(IlP.IMt)  =  «tf'(^LP.I.\IT)  =  0.  (A. 15) 

lb.  Compute  the  locaiiou  of  the  origin  of  the  Cframe  in  e-frame  coordinates: 


O.TAN  — 


•^OTAN 

l/O.TAN 

“0,TA.\ 


(/?«  -i-  /iq.TA.n)  cos  Z-o.TAN  COS  fo, TAN 
(/?0  -f  /io.TAN')  COS  Z-o.TAN  ^O.TAN 
(  -f  /tO.TAN  )  sin  Z-o.TAN 


where  /?.i,  is  the  radius  of  a  spherical  Earth  (6378  km). 

Ic.  Compute  the  location  of  the  LP  in  Cframc  coordinates: 


[A. 16) 


(A. 17} 


CbaSE 


•^BASE 

1/base 
.  "base  . 

(  -f  IibaSe)  cos  Z-baSE  cos  ZbaSE 
( -b  /(base )  cos  Z-base  sin  Zbase 
(ZZtg -f /(base)  sin  Lbase 


Id.  Compute  the  location  of  the  LP  in  e-frame  coordinates: 


P/:p(^I.P.INIt)  —  t’e(CBASE  “  cq.tan) 


(A.18) 

(A.19) 


(A. 20) 


where  the  e-frame  to  ^-frame  DCM  is  given  by 


^'e 

=  (Q)'" 

(A.21) 

=-  ( 

-n^'t 

(A.22) 

cr 

:  Given  by  Equation  A. 94 

(A. 23) 

—  sin  Tbase  cosZba.se  —  sin^BASE 

-  cos  Z-base  cos  Zbase 

= 

—  sin  Z-base  sin  Zbase  cosZbase 

—  cos  Z.base  sin  ZbaSi. 

(A.24) 

cosZ/b^'SE  0 

-sinLBASE 

where  the  superscript  T  indicates  matrix  transposition. 
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J.  (Computation  of  specific  force.  (/'*,  f^):  Because  the  LP  experiences  zero  accelera¬ 
tion.  the  specific  force  in  the  n-franie  is  given  by 


(A.25) 


■  Is  ' 

n 

0 

r  = 

r 

j  i: 

— 

0 

Jo  . 

.  . 

and  in  the  f-fraine 


/6  ^ 


(A. 261 


where  the  ninula  for  is  given  below  in  Step  ./  (Equation  A. 20). 

3.  ('om uutntwn  of  latitude,  longitude.  ultiUide.  and  rates,  [L[^p.  ^ip,  ( ip  hip.  and 
rates):  I  lu'se  (juantities  are  computed  using  'he  following  equations: 


Llp 

—  J-tiASE 

^  LP 

=  ^BASE 

:  Equation  .\.112 

^LF 

=  /'BASE 

Llp 

=  0 

'  LP 

=  0 

^LP 

Ecjuation  .'\.117 

hpp 

=  0 

Llp 

=  0 

£lp 

=  0 

^LP 

Equation  .A.  121 

Computation  of  rotational  parameti  rs.  (6.  0.  e'.  p.  g,  r): 
la.  Compute  Euler  angles  and  DC.M:  During  [C-fi],  the  Euler  angles  (roll,  pitch,  and 
yaw)  are  given  by: 


<p(t)  =  0  (A.27) 

d((}  =  0  (A.28) 

li'(t)  =  Clp.init  (A. 29) 

where  r  [,p,i.\[T  is  the  azimuth  at  time  Th"  corresponding  ri-frame  to  6-frame 

DCM  is: 

=  /-a(CLP.INlT)-  (.A. 30) 

lb.  'i 'ompute  angular  rates:  The  angular  rate.s  with  respect  to  inertial  space  (p,  q, 
and  r)  an'  computed  from  the  angular  rates  w'ith  respect  to  the  n-frame  (F,  Q,  and  R), 
which  in  turn  are  computed  from  the  Euh'r  angle  rates  (0,  0.  and  c): 


'  0  ' 

■  0  ■ 

0 

0 

0 

(A.31) 
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■  p  1  r  0  ■ 

Q  =  Q 

.  ^  J  L  0 . 

pi  r  (^^e  +  f)  cos  L 

q  =  Ci{t)  -L 

r  _  — +  0  sin  L 

where  is  given  by  Equation  A. 30. 

A. 3. 3  Level  Flight  at  Constant  Velocity 

.Assumptions  —  The  model  for  level  flight  is  based  on  the  following  assumptions: 

•  Level  flight  begins  at  time  p  and  ends  at  time 

•  Within  the  [pJi]  time  interval: 

-  The  pitch  and  roll  angles  are  zero 
—  All  accelerations  are  zero 

-  Vertical  velocity  is  zero  (altitude  is  constant) 

•  The  variables  listed  in  Table  A. 2  are  known  at  t\. 

Input  Parameters  —  A  level  flight  segment  is  determined  by  one  input  parameter:  the 
duration  of  the  segment.  t2  —  t\. 

Computation  Algorithm  —  The  objective  of  the  computation  algorithm  is  to  compute 
the  variables  listed  in  Table  A. 2  within  the  [fi,f-2]  interval.  A  four-step  procedure  is 
followed, 

/.  Computation  of  point  mass  t-frame  trajectory  (p^p,  nj^p,  aj^p): 

a[p{t)  =  0  (A.34) 

(A.35) 

Pcpi^)  —  Plp(Ii)  + ''Lp{U)it  —  f\)-  (A. 36) 

2.  Computation  of  specific  force,  (/",  /*"):  Because  the  LP  experiences  zero  accelera¬ 

tion.  the  specific  force  in  the  n-frame  is  given  by 

'  InV  [0  1" 

/"  =  /f  =  0  ,  (A.37) 

.  Id  \  L  . 

and  in  the  6-frame 

/'  =  (A.38) 

where  the  formula  for  C^  is  given  below  in  Step  4- 


(A.32) 

(A.33) 
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S.  Computation  of  latitude,  longitude,  altitude,  and  rates,  [L^p,  Xlp-,  ^LPi  hip,  and 
rates):  These  quantities  are  computed  using  the  following  equations: 


Llp 

Equation  .A.  110 

^LP 

Equation  AT  11 

^LP 

Equation  A.  112 

h-LP 

Equation  A.  113 

Llp 

Equation  A.  115 

^LP 

Equation  A.  116 

^LP 

Equation  A.117 

hip 

Equation  A.  118 

Llp 

Equation  A.  119 

^LP 

Equation  A.  120 

^LP 

Equation  A. 121 

4.  Computation  of  rotational  parameters,  (</>,  0,  if,  p,  q,  r): 

4a.  Compute  Euler  angles  and  DCM:  During  [<i,<2],  the  Euler  angles  (roll,  pitch,  and 
yaw)  are  given  by: 


4>{t)  =  0  (A.39) 

0{t)  =  0  (A.40) 

W)  =  </’i  (A.41) 

where  is  the  azimuth  at  time  C  and  the  small  variation  in  azimuth  because  due  to 
translational  motion  is  neglected.  The  corresponding  n-frame  to  6-frame  DCM  is: 

C^^t)  =  LMi)-  (A.42) 


4b.  (Compute  angular  rates:  The  angular  rates  with  respect  to  inertial  space  (p,  q, 
and  r)  are  computed  from  the  angular  rates  with  respect  to  the  n-frame  (P,  Q,  and  R), 
which  in  turn  are  computed  from  the  Euler  angle  rates  0,  and  0): 


’  <t>  ' 

■  0  ■ 

0 

= 

0 

.  V  . 

,  0 

'  P  ' 

■  0  ■ 

Q 

= 

0 

R 

0 

'  P  ' 

( -t- 0  cos 

9 

=  C^n{l) 

-L 

r 

_  -(17®  +  Osin  L  . 

(A.43) 

(A.44) 

(A.45) 


where  C'f{t)  is  given  by  Equation  A.42. 
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A. 3. 4  Right-Turn  /  Left-Turn 

Assumptions  —  The  model  for  the  turn  is  based  on  the  following  assumptions: 

•  The  turn  begins  at  time  aiul  ends  ai  tune 

•  At  time  /j”  (immediately  before  the  turn)  and  at  time  <4  (at  the  end  of  the  turn): 

-  The  pitch  and  roll  angles  are  zero 
—  All  accelerations  are  zero 
—  Vertical  velocity  is  zero 

•  The  variables  listed  in  Table  A. 2  are  known  at 

•  During  the  turn  (ti  <  t  <  <4)  the  LP  flies  at  a  constant  altitude 

•  The  turn  is  divided  into  three  time  intervals: 

f  \  ^  t  <  12’.  Roll  from  zero  to  the  bank  angle  required  by  the  turn* 
t2  <  t  <  Turn  at  a  constant  bank  angle 
h  ^  U'  Roll  back  to  zero  bank  angle 

•  Within  [<i,  <2]  and  [<3,  <4]  the  LP  rolls  at  a  constant  roll  rate.  This  roll  rate  is  assumed 
to  be  <6r  =  ±90  deg/sec,  positive  for  right-turn  (RT)  and  negative  for  left-turn  (LT) 
([McCormick,  1979]). 

Input  Parameters  —  .A  steady  turn  segment  (also  called  a  “truly  banked”  or  “coordi¬ 
nated”  turn,  [Etkin,  1972],  [Dole,  1981])  is  determined  by  the  following  input  parameters: 

•  Direction  of  the  turn  (right  or  left) 

•  Load  factor  (the  number  of  g's  the  aircraft  "pulls”),  nj 

•  Final  heading,  cq. 

Computation  .Algorithm  —  The  objective  of  the  computation  algorithm  is  to  compute 
the  variables  listed  in  Table  .A. 2  within  each  of  the  three  intervals  ([ii,t2]i  [^21^3)7  and 
[<3,<4]).  The  development  that  follows  is  divided  into  three  parts: 

•  Preliminary  computations 

•  Computations  for  [/i.^i] 

•  C’ornputations  for  [<2,^3] 

•  Computations  for  [^3,^4]. 

*  “Bank  angle”  is  synonymous  with  “roll  angle." 
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The  development  is  based  on  [Etkin,  1972],  [Dole.  1981],  [Anderson,  1989],  and  [Britting, 
1971], 

Preliminary  Computations: 

1.  Computation  of  t-frame  speed: 

Vt  =  (A.46) 

2.  Computation  of  turn  radius: 

Rt  =  -  (A.47) 

gynp -  1 

where  g  =  9.8  m/sec^  is  the  acceleration  of  gravity. 

3.  Computation  of  turn  rate: 


(A.48) 


where  the  plus  sign  corresponds  to  RT  and  the  negative  sign  to  LT. 

f.  Computation  of  turn  interval  duration:  To  compute  the  turn  rate,  compute  first 
the  total  turn  angle,  A0, 

=  [V’4  —  t/'i]36o-  {A.49) 

In  this  equation,  the  subtraction  is  modulus  360  deg,  t-’4  is  the  final  heading  (an  input 
parameter),  and  rl'i  is  the  initial  heading  computed  from 


Tpi  =  arctan 


-  ^ipy / 


The  duration  of  the  turn  interval  is  given  by 

Alb 


Tt  = 


ijJ'J' 


5.  Computation  of  roll  angle: 


<^T  =  i  arccos 


Ut 


(A.50) 


(A.51) 


(A.52) 


a 


+”  for  RT,  for  LT. 

6.  Computation  of  roll  interval:  The  duration  of  the  roll  interval  is  given  by 


7.  Computation  of  times: 


n  = 


<t>T 

<t>T 


^2  —  ti  +  Fr 

I3  =  D  +  +  TV 
Ia  —  f  1  +  2Tr  +  Tj 


(A.53) 
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(A.54) 

(A.55) 

(A.56) 
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8.  Computation  of  turn  center:  The  turn  circle  is  located  at  (xTC^yrc-,  ^Tc)  in  the 
t-frame.  Because  the  turn  occurs  at  a  constant  altitude. 


^TC  — 


(A.57) 


Let  the  vector  from  the  location  of  LP  at  <2  to  the  center  of  the  turn  circle  be  /Zatj 
(the  subscript  indicates  that  this  v^ector  is  the  negative  turn  radius  vector).  Because  of 
Equation  A.57,  the  c-component  of  RrsjT  is  zero.  The  x-  and  j/-components  are  computed 
by  noting  that  at  time  ^2  the  turn  circle  is  in  a  direction  orthogonal  to  the  velocity  vector, 
to  the  right  or  the  left  of  the  pilot,  depending  on  the  direction  of  the  turn,  and  at  a 
distance  Rj  from  the  LP.  Two  cases  need  to  be  considered  as  follows: 


If  VLP^(t2)  ^  0: 


RnTx  =  —p 


aRi 


f^NTy  = 


\ATp^ 

aRj 


where 


P  = 


^LPyih) 


VLPxih) 

The  constant  a  is  set  according  to  the  following  conditions: 

If  LT  and  VLPzih)  >  0  then  o  =  —  I 

If  LT  and  viPiih)  <  0  then  a  =  +1 

If  RT  and  C£,Pi(<2)  >  0  then  a  =  +1 

If  RT  and  C£,pj,(t2)  <  0  then  a  =  —  1. 


(A. 58) 
(A.59) 

(A.60) 


If  U£,Px(^2)  =  0: 


RnTx  —  ^Rt 
RNTy  =  0. 

For  this  case,  the  constant  a  is  set  according  to  the  following  conditions: 


(A.61) 

(A.62) 


If  LT  and  Cf,Py(<2)  >  0  then  a  =  +1 

If  LT  and  vipy{t2)  <  0  then  a  =  —  1 

If  RT  and  Pr,py(<2)  >  0  then  a  =  — 1 

If  RT  and  VLPyih)  <  0  then  a  =  +1. 

The  center  of  the  turn  circle  is  then  computed  from  the  negative  turn  radius  vector. 


(A.63) 


XTC 

t 

PlPx(^2) 

t 

RnTx 

yrc 

PLPy(^2) 

+ 

RNTy 

^TC 

.  P/,Px(^2)  . 

RnTz 
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Computations  for  [CC2]:  Within  this  interval  a  four-step  procedure  is  followed. 

1.  Computation  of  point  mass  t-frame  trajectory  {pip,  v^p,  a^[^p): 

a^pit)  =  0  (A.64) 

~  (A. 65) 

Pipi^)  ~  Plp(0  +  )(^  ~  O-  (A. 66) 

2.  Computation  of  specific  force,  (/”,  /*"):  Because  the  LP  experiences  zero  acceler- 
cation  (and  the  INS  is  assumed  to  be  located  at  the  center  of  mass),  the  specific  force  in 
the  n-frame  is  given  by 

'InV  r  0  ]” 

r  ^  fp  =  Q  ,  {A.67) 

.Id  .  .  ~9  . 


and  in  the  6-frame 


f  =  Ctr  (A.68) 

where  the  formula  for  C^  is  given  below  in  Step  4- 

■].  Computation  of  latitude,  longitude,  altitude,  and  rates,  [Lip,  Xip,  (ipp-,  hlPi  3,nd 
rates):  These  quantities  are  computed  using  the  following  equations: 


Equation 

Equation 

Equation 

Equation 

Equation 

Equation 

Equation 

Equation 

Equation 

Equation 

Equation 


A.llO 
A. Ill 
A. 112 
A.113 
A. 115 
A. 116 
A. 117 
A. 118 
A. 119 
A. 120 
A. 121. 


4.  Computation  of  rotational  parameters,  {(f,  0,  t/q  p,  q,  r): 

4a.  Compute  Euler  angles  and  DCM:  During  [<1,^2]!  the  Euler  angles  (roll,  pitch,  and 
yaw)  are  given  by: 


d>(t)  —  —  U) 

e{t)  =  0 

if{t)  =  i/’i 


(A.69) 

(A.70) 

(A.71) 


where  is  the  azimuth  at  time  ti.  The  corresponding  n-frame  to  6-frame  DCM  is: 


C^Jt)  =  LAm)U4h)- 


(A.72) 
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4b.  Compute  angular  rates:  The  angular  rates  with  respect  to  inertial  space  (p,  q, 
and  r)  are  computed  from  the  angular  rates  with  respect  to  the  n-frame  (P,  Q,  and  R), 
which  in  turn  are  computed  from  the  Euler  angle  rates  {<f),  6,  and  tp): 


’  ^  ' 
0 

.  4’ . 

■  p  ■ 

Q 


4>t 

0 

0 


Lrim) 


<t> 

6 


(A.73) 

(A.74) 


R 


V’  J 


’  p ' 
9 

■  P  ■ 

Q 

i 

(ff®  -)-  ()  COS  L 
-L 

(A.75) 

r 

R 

—  (Q®  +  1)  sin  L 

where  C^{t)  is  given  by  Equation  A. 72. 

Computations  for  [<2,^3]:  Within  this  interval  a  four-step  procedure  is  followed. 

1.  Computation  of  point  mass  t-frame  trajectory  [p^ip,  vjp,  a^[^p):  Consider  first  the 
position.  Pip{t),  te[t2,  fa].  In  the  6(f2)-frame  (body  frame  at  time  t2)  the  trajectory  during 
the  turn  is  simply  a  circle  specified  by 


Pz,p(f  )rt^  ~ 

c(f)  sin  Q;(f) 

c(f)  COS  Q(f) 

0 

PLp(f)LT''  ~ 

c(f)sinQ;(f) 

— c(f)  cos  o(f] 

0 

(A.76) 

(A.77) 


where  the  first/second  equation  apply  to  RT/LT,  and: 


c{t) 

7(0 

ait) 


sin  7(f) 

^ 

sin  a(t) 
ujrit  —  fa) 

^  -  7(0 
2 


(rad). 


(A.78) 

(A.79) 

(A.80) 


The  trajectory  in  the  6(fi)-frame  is  transformed  to  the  f-frame  by  means  of: 


PlpW  =  PlpM  +  (A.81) 

This  equation  states  that  the  LP  position  in  the  f-frame  is  the  sum  of  two  vectors  expressed 
in  the  f-frame:  the  position  of  the  origin  of  the  6(f2)-frame  plus  the  location  of  the  LP  in  the 
6(f2)-frame.  To  express  the  second  vector  in  the  f-frame,  the  vector  is  transformed,  using 
DCMs,  from  the  ^(fa)  to  the  n(f2)  to  the  f  frames.  The  DCM  for  the  first  transformation 
is  given  by: 

cos  ipi  —  sin  xpi  0 
sin  ipi  cos  ipi  0 
0  0  1 


pyn(h)  _ 
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(A.82) 
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where  ?/’i  is  the  heading  at  the  beginning  of  the  turn  maneuver.  And  the  DCMs  for  the 
second  transformation  is  given  by: 


.  2  r  Ai>  ■  r 

- 7“- sin  Lo  sin  Lo 


-Ai?i(sin  Zo  +  AZ-i  cos  Lo)  1  — 


— AZi  —  ^sin2Zo 
— A£i(cos  Lo  —  AZi  sin  Lo) 


AZi  —  ^  sin  2Lo 


A£i  cos  Lo  1  —  ^  cos^  Lo 


(A.83) 


where 


AZi  —  L\  —  Zo.TAN 
—  ^O.TAN 

Li,ii  =  Latitude  and  terrestrial  longitude  of  the  origin  of  the  n(<i)-frame 
^o, TAN,  ^o, TAN  =  Latitude  and  terrestrial  longitude  of  the  origin  of  the  i-frame. 

The  velocity  and  acceleration  in  the  Tframe  (n^p  and  a^p)  are  obtained  by  differen 
tiating  Equation  A. 81  to  obtain: 

01P«)'  =  (a.84 

«tp(o'  =  (a.85 

The  derivatives  on  the  right-hand  side  for  right-turns  are: 

r  , .  o  _ n  ^*2) 


(A.84) 

(A.85) 


where  the  functions  /i  and  /2  are  given  by: 

r  n  cos  7(0  ,  uJtRt  sin 7(0 

/l(0  =  ujtRt- - 777  +  ^; - r  j—rR 

tanQ(<)  2  sin  o(0 


ujRt  cos  7(0 


hit) 

(A.86) 

0 

■  sin  7(0 

hit) 

(A.87) 

2n  sin7(0  ,  20  cos7(0  ,  .  cosa(0 

/2(0  =  ~^^^^t'ana(0  +  "■■^7(0_:_3 .771 


,  2  D  ^  ''  '  I 

+  2  - d —  ®"^'l(0“r-3 


And  for  left-turns: 


;PLp{if"> 


sin'^  o(0 


u>tRt  cos  7(0 

-hit) 

0 

—ujjRt  sin  7(0 

-hit) 

0 


sin^  a(0 


(A.88) 

(A.89) 


(A.90) 


(A.91) 
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2.  Computation  of  specific  force,  (/",  /*’):  The  computation  of  specific  forces  is  a 
five-step  process. 

2a.  Compute  the  LP  current  latitude,  terrestrial  longitude,  and  rates  as  follows:^ 

•  L  and  i  from  pLp[if  (which  is  available  from  Equation  A. 81) 

•  L  and  f  from  vip{tY  (which  is  available  from  Equation  A. 84) 

•  Z  and  I  from  aip[ty  (which  is  available  from  Equation  A. 85). 

The  equations  for  these  computations  are  given  in  paragraph  3,  below. 

2b.  Transform  vip{tY  (given  by  Equation  A. 84)  from  the  /-frame  to  the  current  n- 
frame: 


VLp{tr 


^’lp.n 

^LP,E 
^LP.D  J 

=  CfivLpity 


(A.92) 

(A.93) 


where 


1  —  ^  sin^  Lo 

— A£(sin  Lo  -1-  AZ  cos  Lo) 

AZ  -  sin  2Lo  ' 

cr  = 

Ai  sin  Lo 

1  aC 

2 

A(  cos  Lo 

— AZ  —  ^  sin  2Lo 

— Af(cosZo—  AZsinZo) 

1  -  ^  ^  cos^  Lo  . 

and,  as  in  Equation  A. 83, 


AZ  =  Z  —  Zo.TAN 
Ai  =  (  -  fo.TAN- 


(A.94) 

(A.95) 

(A.96) 


2c.  Transform  app(ty  (given  by  Equation  A. 85)  from  the  /-frame  to  the  current  n- 
frame  using  the  theorem  of  Coriolis  ([Britting,  1971]): 


ai,p(0"  = 


^LP,N 
^LP.E 
^LP.D  J 


=  cyappity  +  n’:,,cyvpp{ty 


(A.97) 

(A.98) 


where  Cf  is  given  by  Equation  A.94  and  (2"^  is  the  skew-symmetric  matrix  ([Britting, 
1971])  corresponding  to  the  angular  velocity  of  the  /-frame  relative  to  the  n-frame: 


Q"  = 


0  —(s'mL  L 
IsinL  0  icosL 
—  L  —icosL  0 


(A.99) 


^Shorthand  notation;  L  =  Lpp,  i  =  ipp,  A  =  A/,p,  h  =  hpp. 
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2d.  Compute  the  specific  force  in  the  rr-frame; 


/"  = 


^LP,N  +  +  2fi^)  sin  L  —  Lv'lpQ 

^1p,e  ~  +  '“P®)  sin  L  —  +  2fl®)  cos  L 

^1p,d  +  Vip  p[C  +  21)0)  cos  L  4-  Lv’lpyf  —  g 


(A.IOO) 


(A.lOl) 


where  the  subscripts  jV,  E,  and  D  identify  the  North,  East,  and  Down  components. 
2e.  Compute  the  specific  force  in  the  6-frame: 


/6  ^ 


(A.102) 


where  is  computed  in  Step  4- 

3.  Computation  of  latitude,  longitude,  altitude,  and  rates,  {Llp,  ^lp,  tip,  hip,  and 
rates):  The  computation  of  these  quantities  is  a  5-step  process.^ 

3a.  Compute  the  location  of  the  origin  of  the  Cframe  in  e-frame  coordinates: 


O.TAN  = 


^0,TAN 
2/0, TAN 
^O.TAN  . 

{Rq  -f  6o.TAn)  COS  To, TAN  COS  ^o.TAN 

(/?0  +  6o,tan)  COS  To.tan  sin  ^o, tan 
( /?®  +  6o,tan  )  sin  To, TAN 


where  7?^  is  the  radius  of  a  spherical  Earth  (6378  km). 

3b.  Compute  the  location  of  the  LP  in  e-frame  coordinates: 


(A.103) 


(A. 104) 


'IP  =  yip 

L  ^ip  J 

=  ^O.TAN  +  ^tPlP 

where  the  (-frame  to  e-frame  DCM  is  given  by 

C7  =  Qcr 

C"  :  Given  by  Equation  A. 94 

—  sin  T  cos  (  —  sin  i  —  cos  T  cos  i 
C®  =  —  sinTsin£  cosi  —  cosTsin£ 

cos  T  0  —  sin  T 


(A.105) 

(A.106) 


(A.107) 

(A.108) 

(A.109) 


^Shorthand  notation:  L  =  Ltp,  (  =  tip,  A  =  A^p,  h  =  hip. 
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3c.  Compute  the  latitude,  longitudes,  and  altitude  of  the  LP: 


L  =  arcsin  (  \ 

(A.llO) 

i  =  arctan  f 

Wlp) 

(A.lll) 

A  —  ^ 

(A.112) 

h  —  6o,tan  —  Plpz  +  AZ,  p).  +  AZ  cos  Cq.tan  PiPy 

(A.113) 

where  time  (<)  is  GMT  and 

Ikipll  =  \/i^Lpy  +  {VlpY  +  {^lpY  ■ 

(A.114) 

3d.  Compute  first  derivatives: 

£  _  ^LP,N 

Ri^  -|-  h 

(A.115) 

^  ^  ^lp,e 

[R^  -f  h)  cos  L 

(A.116) 

-h 

II 

(A.117) 

^  +  ^PLPx  +  Lo.TAN  Pr,Py  +  A£cOS  Z/O.TAN  ^^i,Py(A.118) 


3e.  Compute  second  derivatives: 


i 

I 

A 


^\p,N  ~  ^  ^ 

R®  +  h 

OE^P  p  h£  cos  />"!“(  R(^  "h  h^iij  sm  C 
( Rq,  +  h )  cos  L 

I 


(A.119) 

(A.120) 

(A.121) 


Computation  of  rotational  parameters,  (<f>,  0,  if,  p,  q,  r): 

4a.  Compute  Euler  angles  and  DCM:  During  [<2)^315  the  Euler  angles  are  given  by: 


<^(0  =  4>t  (A.122) 

0{t)  =  0  (A.123) 

if{t)  =  if\  ijjj{t  —  <2)-  (A. 124) 

The  corresponding  n-frame  to  6-frame  DCM  is: 

c^it)  =  LA<i>T)La{iit)).  (A.125) 


4b.  Compute  angular  rates:  Following  a  procedure  similar  to  that  for  the  [<i,<2] 
interval,  the  following  calculations  provide  the  angular  rates  with  respect  to  inertial  space 
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(p,  q,  and  r) 


Lt{4>t)  0 

.  0  . 

■  P  ■ 

Q  +ct(t) 

R 


+  ^)cos  L 
-L 

—  (Q^  +  1)  sin  L 


(A.126) 


(A.127) 


(A.128) 


where  C^{t)  is  given  by  Equation  A.  125. 

Computations  for  [^3,^4]:  Within  this  interval  a  four-step  procedure  is  followed. 

1.  Computation  of  point  mass  t-frame  trajectory  (p^p,  Vpp,  a^ip)\ 


^£,p(0  =  <'’ip(^3) 

PLpi^)  —  pLp{^3)  +  ’^Lpi^3){t  —  t^). 


(A.129) 

(A.130) 

(A.131) 


2.  Computation  of  specific  force,  (Z'^,  /*’):  Because  the  LP  experiences  zero  accelera¬ 
tion  the  specific  force  in  the  n-frame  is  given  by 


r  = 


(A.132) 


and  in  the  6-frame 

Z'^C^V"  (A.  133) 

where  the  formula  for  C*  is  given  below  in  Step  j. 

3.  Computation  of  latitude,  longitude,  altitude,  and  rates.  [Lip,  X^p,  (pp-,  hpp,  and 
rates):  These  quantities  are  computed  using  the  following  equations: 


Llp  Equation  A. 110 

^LP  Equation  A.l  1 1 

Xpp  :  Equation  A.l  12 

hip  Equation  A.  113 

Lip  Equation  .4.115 

^LP  Equation  A.  116 

X[^P  :  Equation  A.l  17 

Llp  Equation  A.  118 

Lip  Equation  A.  119 

ipp  Equation  A.  120 

Xpp  Equation  A.  121. 
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4.  Computation  of  rotational  parameters,  (<?,  0,  ii,\  p,  q,  r): 

4a.  (.'ompute  Euler  angle.s  and  DCM:  During  [c'3,/,],  the  Euler  angles  are  given  by: 


0(1)  =  0T  —  ^t[1  —  h)  (A. 134) 

e{t)  =  0  (A. 135) 

W)  =  </’3-  (A. 146) 

The  corresponding  7!-frame  to  fe-frame  DCM  is: 

Ci[t)  =  (A.137) 


4b.  Compute  angular  rates:  Following  a  procedure  similar  to  that  for  the  [<1,^2] 
in!  erval,  the  following  calculations  provide  the  angular  rates  with  respect  to  inertial  space 
(p,  r/,  and  r): 


0 

—  0T 

0 

0 

L  F  J 

0 

P 

Q 

R 


=  Lrim) 


<i> 

0 

0 


'  p ' 

■  P  ■ 

+  c:{t) 

+  f.)  cos  L 

Q 

= 

P 

-L 

r 

R 

.  — (Oe  +  ()  sin  L 

(A.  138) 


(A.139) 

(A.140) 


where  C*(C  is  given  b”  Equation  A.137. 


A. 3. 5  Climb  and  Descent 

.Assumptions  —  The  model  for  climb  and  descent  segments  is  based  on  the  following 
assumptions: 

•  The  segment  begins  at  time  ti  and  ends  at  time  <3 

•  The  [/lAa]  interval  is  divided  into  two  subintervals  during  which  a  bang-bang  accel¬ 
eration  control  is  applied: 

—  During  [A,  <2])  ^he  LP  experiences  a  total  (inclusive  of  gravity)  upward  vertical 
acceleration  +ncD9-  (1^  ^cd  is  negative  then  the  acceleration  is  downward) 

-  During  [C-b,],  the  LP  experiences  a  total  upward  vertical  acceleration  —ncD9 

•  At  times  t^  and  <3,  vertical  velocity  and  acceleration  are  zero 

•  At  all  times,  the  horizontal  acceleration  and  the  roll  angle  are  zero 

•  At  all  times,  the  velocity  vector  points  along  the  centerline  of  the  LP 


40 


SynQtlcs 


•  At  all  times,  the  pitch  rate  ecpials  the  flight -|)ath  angle  rate‘ 

•  hhe  variables  listed  in  Table  A..*  are  known  at 

Input  Parameters  —  .A  climb/deseend  flight  segment  .  determined  by  two  parameters: 

•  Final  altitude  at  time  hj,  h:> 

•  Magnitude  of  the  vertical  acceleration  of  the  LP  in  g's,  |ncD|- 

Computation  .Algorithm  —  The  objective  of  the  computation  algorithm  is  to  compute 
the  variables  listed  in  Table  A. 2  within  the  [<17^3]  interval.  five-step  procedure  is 
followed. 

/.  Preliminary  Computations. 
la.  Compute  times  (t2  and  ^3): 


lb.  (.'ompute  nco- 


h 

f-s 

A 


/i  +  A 
^2  +  -^ 

Ihj  —  lix 

V  ncog 


If  /13  >  hi  then  nco  =  Thcol 
If  /i3  <  hi  then  nco  =  -hcol- 


(A.141) 

(A.142) 

(A.143) 


(A. 144) 
(A.145) 


2.  Computation  of  point  mass  t-frame  trajectory  {p^ip,  v^p,  a^i^p): 
Horizontal  motion.  ti  <  t  <  <3: 


=  0  (A.146) 

«U(0  =  0  (.A.147) 

~  (A. 148) 

—  ''LPyi^ll  (A. 149) 

P^LPii^)  —  /4pr(H  )  +  )(^  ~  C  )  (A. 150) 

PLpy(0  =  /4py(^l  )  +  'TPylH  )(^  -  C  )•  (A. 151) 

Vertical  motion,  /j  <  t  <  <2^ 

«r,Px(0  =  -rh-vy  (A.152) 

'4.Pz(^)  =  -ricDy(l  -  h)  (A. 153) 

Pppz(0  =  /'o.TAN  —  hi  —  {t  ~  ti''^.  (A. 154) 


^The  flight.-[  ath  angle  i.s  the  angle  between  the  velocity  vector  and  the  horizontal  plane  (e.g.,  [Farrell. 

19761). 
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Vertical  motion,  t^  <  t  <  t^-. 

^LPzi^)  — 

+ncD  g 

(A.155) 

‘’lps(0  = 

-62  +  ncDg(l  -  fz) 

(A.156) 

60.T.A..N  iizil  (-z)  +  ^  [t  tz) 

(A. 157) 

where 

61-1-63 
h,  =  ^ 

(A.158) 

62  =  ncDg{tz-t\)- 

(A.159) 

3.  Computation  of  specific  force,  (/",  /*):  The  acceleration  experienced  by  the  LP  in 
the  t-frame  is  given  by 

o  ' 

0 


^LP  — 


‘■LPz  J 


(A.160) 


Consequently  the  specific  force  experienced  by  the  LP  in  the  n-frame  is  given  by 


In 

n 

■  0  ■ 

r  = 

Ie 

r^n  A 

-  a^p  - 

0 

.  fo  . 

.  9  . 

(A.161) 


where  C"  is  given  by  Equation  A. 94.  In  the  6-frame 

/*  =  ctr 


(A.162) 


where  the  formula  for  is  given  below  in  Step  5. 

4-  Computation  of  latitude,  longitude,  altitude,  and  rates.  (L^p,  XlP’,  f-LPi  ^LPi  and 
rates):  These  quantities  are  computed  using  the  following  equations: 


Lip  :  Equation  A. 1 10 

^IP  Equation  A.lll 

\iP  :  Equation  A. 112 

hip  Equation  A.  1 13 

Li^P  Equation  A. 115 

^LP  Equation  A.  116 

\ip  Equation  A.  117 

Llp  Equation  a. 1 18 

Lpp  Equation  A.  119 

^LP  Equation  A. 120 

\ip  Equation  A.  121. 

.5.  Computation  of  rotational  parmnetrrs,  (d>,  0,  i/’,  p,  q,  r): 
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5a.  Compute  Euler  angles  and  DCM;  During  the  Euler  angles  (roll,  pitch,  and 

yaw)  are  given  by: 


0 

II 

(A.163) 

/  —  t'  \ 

9(t)  —  arctan  — 

Vl  / 

(A.164) 

II 

(A.165) 

where  c'l  is  the  azimuth  at  time  C  and 

oi  =  Velocity  in  the  level  (horizontal)  plane 
—  \Ji'^LPx)^  +  i^LPy)^- 

(A.166) 

(A.167) 

The  corresponding  7r-frame  to  6-frame  DCM  is: 

Ctit)  =  L,(0)L„(v,). 

(A.168) 

5b.  Compute  angular  rates:  The  angular  rates  with  respect  to  inertial  space  (p,  q, 
and  r)  are  computed  from  the  angular  rates  with  respect  to  the  7r-frame  (P,  Q,  and  R), 
which  in  turn  are  computed  from  the  Euler  angle  rates  and  V-O- 


4> 

e 

i-' 

P 

Q 

R 


0 

t 

LPi 

0 


-t'l 

(u()2  +  („<,  LPz 


1  0 
0  1 
0  0 


—  sin  0 
0 

cos  0 


■  <i>  ■ 

0 

.  i' . 

’  p  ' 

— 

■  P  ■ 

Q 

+  ct(0 

(D.5  -1-  f)  cos  L 
-L 

r 

L 

—  (Dig  -1-  i)  sin  L 

where  C^{t)  is  given  by  Equation  A. 168. 


(A.169) 


(A.170) 


(A.171) 


A. 3. 6  Level  Change  of  Speed 

Assumptions  —  The  model  for  a  level  change-of-speed  is  based  on  the  following  assump¬ 
tions: 

•  Flight  begins  at  time  and  ends  at  time  <2 

•  Within  the  [CC2]  time  interval: 

-  The  heading  angle  remains  constant 

-  The  pitch  and  roll  angles  are  zero 

-  Vertical  acceleration  and  velocity  are  zero  (altitude  is  constant) 
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-  The  magnitude  of  the  level  acceleration  is  constant  (and  representative  of  the 
maximum  acceleration  that  the  LP  can  develop) 

•  The  variables  listed  in  Table  A. 2  are  known  at 

Input  Parameters  —  A  change-of-speed  flight  segment  is  determined  by  two  input 
parameters: 

•  Final  horizontal  (level)  velocity,  vi^ 

•  Magnitude  of  level  acceleration  in  g's,  l;i/|  . 

Computation  Algorithm  —  The  objective  of  the  computation  algorithm  is  to  compute 
the  variables  listed  in  Table  A.2  within  the  [<1,^2]  interval.  four-step  procedure  is 
followed. 

1.  Preliminary  Computations. 

la.  Compute  the  initial  speed,  vn: 


Vll  — 

(A.172) 

lb.  Compute  the  final  time,  ti: 

,  ,  ,  k/2-i’al 

(A.173) 

Ic.  Compute  the  final/initial  speed  ratio,  p;,  if  vn  >  0: 

■5. 

II 

(A.174) 

Id.  Compute  r?;: 

If  I'll  =  0  or  Pi  >  1  then  n/  =  +|«/| 

(speed-up) 

(A.175) 

If  P;  <  1  then  n;  =  —  |n/j 

(slow-down). 

(A. 176) 

2.  Computation  of  point  mass  t-frame  trajectory  [p’^^p. 

^t,p»  “Lp)' 

2a.  Compute  acceleration  in  the  Cfrarne.  a^p,  ti  <  t  <  12'. 

If  I'll  =  0  (start-up  on  the  ground): 

=  i«f|5COS0i  (A. 177) 

«LPy  =  \nt\gsinil'i  (A. 178) 

«Lpz  =  0  (A.179) 

where  V’l  is  the  heading  at  ti. 

If  i=-  0  (speed-up  or  slow-down): 


(  *'’LPx(^i) 

«LPx  —  ,  ^19 

(A.180) 

vn 

i  ^Lpy(^l) 

«.Py  = 

(A.181) 

^‘lpz  =  0. 

(A. 182) 
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2b.  Compute  position  and  velocity,  ti  <  t  <  <2- 

~  ~  O  (A. 183) 

Plp(0  =  PLpi^i) ~  2^Lpi^  ~  ^i)^-  (A.lo4) 

■3.  Computation  of  specific  force.  (/",  /*): 

■/.vi"  [or 

r=  fE  =cra[p-  0  ,  (A.185) 

.Id  ,  .  9  . 

where  C"  is  given  by  Equation  A. 94.  In  the  fpframe 

r  =  0"  (A.186) 

where  the  formula  for  C*  is  given  below  in  Step  5  (Equation  A. 190). 

C  Computation  of  latitude,  longitude,  altitude,  and  rates,  {Lip,  Xip,  iip,  hpp,  and 
rates);  These  quantities  are  computed  using  the  following  equations: 

Lip  :  Equation  A.  110 
iiP  Equation  A.lll 
\lp  :  Equation  A. 112 
hip  Equation  A.  113 
Lip  :  Equation  A. 115 
iip  Equation  A.  116 
\iP  ;  Equation  .^.117 
hip  Equation  A. 1 18 
Lip  Equation  A.  119 
dip  Equation  A.  120 
Xip  Equation  A.  121. 

5.  Computation  of  rotational  parameters,  {(j),  0,  if,  p,  9,  t")'- 

5a.  Compute  Euler  angles  and  DCM:  During  [ti,<2]i  the  Euler  angles  (roll,  pitch,  and 
yaw)  are  given  by: 

4>{t)  =  0  (A.187) 

6{t)  ^  0  (A.188) 

ip{t)  -  tp]  (A. 189) 

where  is  the  azimuth  at  time  C  and  the  small  variation  in  azimuth  because  due  to 
translational  motion  is  neglected.  The  corresponding  n-frame  to  5-frame  DCM  is; 

Ciit)  =  LAih).  (A.190) 
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5b.  Compute  angular  rates:  The  angular  rates  with  respect  to  inertial  space  (p,  q, 
and  r)  are  computed  from  the  angular  rates  with  respect  to  the  n-frame  (P,  Q,  and  R), 
which  in  turn  are  computed  from  the  Euler  angle  rates  (0,  6,  and  i/’): 


’  ' 

■  0 ' 

e 

0 

.  0 . 

0 

[^1 

■  0  ■ 

Q 

= 

0 

.  R 

0 

’  p ' 
<? 

=  c;(i) 

(fl®  -1-  £)  cos  L 
-L 

r 

.  -(H®  +  £)  sin  L  . 

(A.191) 

(A.  192) 

(A.193) 


where  C^{t)  is  given  by  Equation  A.  190. 


A -3.7  Ground  Azimuth  Change 

An  azimuth  change  while  on  the  ground  is  executed  by  rotating  the  aircraft  about  the 
Down  axis  of  the  n-frame. 

Assumptions  —  The  model  for  an  azimuth  change  is  based  on  the  following  assump¬ 
tions: 

•  Azimuth  change  begins  at  time  ti  and  ends  at  time  t2 

•  Within  the  [^1,^2]  time  interval: 

—  The  heading  angle  varies  linearly  with  time 
—  The  pitch  and  roll  angles  are  zero 

-  Horizontal  and  vertical  accelerations  and  velocities  are  zero 

•  The  magnitude  of  the  azimuth  rate  is  |u;n|  =  20  deg/sec 

•  The  variables  listed  in  Table  A. 2  are  known  at  tj. 

Input  Parameters  —  A  change  of  azimuth  is  determined  by  two  input  parameters: 

•  Final  heading,  ip2 

•  Clockwise  (CW)  or  Counter-Clockwise  (CCW)  turn. 

Computation  Algorithm  —  The  objective  of  the  computation  algorithm  is  to  compute 
the  variables  listed  in  Table  A. 2  within  the  [<i,t2]  interval.  A  five-step  procedure  is 
followed. 

/.  Preliminary  Computations. 
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la.  Compute 


r  +20  deg/sec  if  CW 
\  -20  deg/sec  if  CCW 


lb.  Compute  the  final  time,  (2: 


^‘lp2  tAljmodulo 

12  —  - 


(A.194) 


(A.195) 


where  i/i’i  and  ^/’2  are  the  initial  and  final  azimuths  and  the  qualifier  “modulo”  indicates 
that  the  difference  should  be  taken  modulo  360  deg  and  taking  into  account  the  direction 
of  turn. 

2.  Computation  of  point  mass  t-frame  trajectory  {p^p,  v^p,  a\^p): 

2a.  Velocity  and  Acceleration:  For  ti  <  t  <  <2, 


—  ^Lp{^)  —  0- 


(A.196) 


2b.  Position:  For  ti  <  t  <  <2, 


Pipi^)  —  Pz,p(^i)- 


(A.197) 


3.  Computation  of  specific  force,  (/",  /**):  Because  the  center  of  mass  of  the  LP 
experiences  zero  acceleration,  the  specific  force  in  the  n-frame  is  given  by 


In 

n 

0  ■ 

r  = 

Ie 

= 

0 

.  Id  . 

.  -9  . 

(A.198) 


and  in  the  6- frame 

/'’  =  C^p  (A.199) 

where  the  formula  for  C*  is  given  below  in  Step  5  (Equation  A.203). 

4.  Computation  of  latitude,  longitude,  altitude,  and  rates,  [Lip,  Xip,  itPi  hiPi  ^.nd 
rates):  During  the  [fi,<2]  interval  these  quantities  are  given  by: 


Llp  =  Lt, 

^LP  = 

\lp  Equation  A. 112 

hiP  =  hti 

Lip  =  0 

iiP  =  0 

\lp  Equation  A.  117 

hip  =  0 

Llp  =  0 

^LP  =  0 

Xlp  Equation  A. 121. 
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5.  Computation  of  rotational  parameters,  {<t>,  6,  ip,  p,  q,  r): 

5a.  Compute  Euler  angles  and  DCM:  During  [ti,<2])  the  Euler  angles  (roll,  pitch,  and 
yaw)  are  given  by: 


(l>{t)  =  0  (A.200) 

e{t)  =  0  (A.201) 

1p{t)  =  V’l  +  tJa  (^2  ~  ).  (A. 202) 

The  corresponding  n-frame  to  6-frame  DCM  is: 

dit)  =  umy  (a.203) 


5b.  Compute  angular  rates:  The  angular  rates  with  respect  to  inertial  space  (p,  q, 
and  r)  are  computed  from  the  angular  rates  with  respect  to  the  n-frame  (P,  Q,  and  R), 
which  coincide  with  the  Euler  angle  rates  {(f),  0,  and  if): 


0 

■  0 

0 

= 

U 

.  0  . 

■  P  ' 

’  ^  ' 

0  ■ 

Q 

= 

0 

= 

0 

R 

.  'P  . 

.  . 

'  P  ' 

■  P  ' 

(fi0  d"  1)  COS  L 

9 

= 

Q 

+  d{t) 

-L 

r 

R 

— (D®  +  1)  sin  L 

(A.204) 

(A.205) 

(A.206) 


where  C^{t)  is  given  by  Equation  A.203. 


A. 3. 8  Constant  Acceleration 

A  constant  acceleration  trajectory  is  needed  for  the  propagation  of  the  M  INS  dynamics 
during  flyout  as  described  in  Subsection  A. 9.9.  Motion  variables  for  such  a  trajectory  are 
defined  in  the  following  paragraphs.^ 

Assumptions  —  The  model  for  a  constant  acceleration  segment  is  based  on  the  follow¬ 
ing  assumptions: 

•  The  segment  begins  at  time 

•  After  <1  all  accelerations  are  constant 

•  At  all  times,  the  roll  angle  is  zero 

^Notation:  Even  though  the  constant  acceleration  event  is  necessary  only  to  analyze  M  motion  after 
launch,  “LP”  is  used  to  label  variables  in  this  subsection  to  maintain  consistency  with  the  development 
of  previous  subsections. 
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•  At  all  times,  the  velocity  vector  points  along  the  centerline  of  the  LP  (pitch  rate 
equals  the  flight-path  angle  rate) 

•  The  variables  listed  in  Table  A. 2  are  known  at 

Input  Parameters  —  A  constant  acceleration  segment  is  determined  by  three  param¬ 
eters: 


•  a/,r  =  level  acceleration  in  the  North  direction 

•  a;  y  =  level  acceleration  in  the  East  direction 

•  =  vertical  acceleration  (Down  direction). 


Computation  Algorithm  —  The  objective  of  the  computation  algorithm  is  to  compute 
the  variables  listed  in  Table  A. 2  for  times  after  ti.  A  five-step  procedure  is  followed. 

1.  Preliminary  Computations. 

2.  Computation  of  point  mass  t-frame  trajectory  (p‘^p,  dip)' 


Acceleration: 


dip  — 


dlx 

dl.y 

dz 


(A.207) 


Velocity: 


dipit)  —  dip{t\)  +  (^  ~  ti)aip. 


(A.208) 


Position: 

P^pi^)  —  P^Lp{l\)  +  ~  +  '^{1  ~  h)^d^ip-  (A. 209) 


3.  Computation  of  specific  force,  (/",  /*"):  The  acceleration  experienced  by  the  LP  in 
the  i-fiame  is  given  in  t^qaatiou  A.2u7.  Consequently  the  specific  force  experienced  by 
the  LP  in  the  n-frame  is  given  by 


In 

n 

'  0  ■ 

r  = 

Ie 

/^n  t 

—  '■'t  dip  — 

0 

.  fo  . 

.  9  . 

where  C"  is  given  by  Equation  A. 94.  In  the  6-frame 


/6  ^ 


where  the  formula  for  C^  is  given  below  in  Step  5. 


(A.210) 


(A.211) 
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4.  Computation  of  latitude,  longitude,  altitude,  and  rates,  {Lip,  Xlpi  hip,  and 
rates);  These  quantities  are  computed  using  the  following  equations: 


Llp 

Equation  A.  110 

^LP 

Equation  A.lll 

Xlp 

Equation  A.  112 

hiP 

Equation  A.113 

Llp 

Equation  A.115 

^LP 

Equation  A.  116 

Xlp 

Equation  A. 117 

hiP 

Equation  A.  118 

Llp 

Equation  A.  119 

^LP 

Equation  A.  120 

^LP 

Equation  A.  121 

•5.  Computation  of  rotational  parameters,  {<f>,  0,  p,  q,  r): 

5a.  Compute  Euler  angles  and  DCM:  After  <1,  the  Euler  angles  (roll,  pitch,  and  yaw) 
are  given  by; 


II 

0 

(A.212) 

9{t)  =  arctan  y 

(A.213) 

tl){t)  —  arctan  ( 

\VLPx/ 

(A.214) 

where 

vi  =  Velocity  in  the  level  (horizontal)  plane 

(A.215) 

=  \J{'^LPxY  +  i^LPy)L 

(A.216) 

The  corresponding 

n-frame  to  6-frame  DCM  is: 

C^(<)  =  L,i9)LM')- 

(A.217) 

5b.  Compute  angular  rates:  The  angular  rates  with  respect  to  inertial  space  (p,  q, 
and  r)  are  computed  from  the  angular  rates  with  respect  to  the  n-frame  (P,  Q,  and  R), 
which  in  turn  are  computed  from  the  Euler  angle  rates  (d>,  9,  and  i/>): 

’  <A  ' 

9 

.  . 

■  P  ■ 

R 


Z21L. 


(•'LPx)"  +  (*'LPy)^ 


1  0 
0  1 
0  0 


—  sin  9 
0 

COS0 


■  (f>  ■ 

9 

.  i' . 

(A.218) 


(A.219) 
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’  p ' 
Q 

■  P  ' 

Q 

+  Ctit) 

(D*  -b  £)  cos  L 
-L 

r 

R 

— (0,5  -f-  i)  sin  L 

where  is  given  by  Equation  A. 217. 

A.4  M  INS  Model 


(A.220) 


The  model  for  the  M  strapdown  INS  is  given  by  Equation  B.l  of  Appendix  B  with  the 
following  modifications: 

•  Because  the  M  INS  is  a  strapdown  system,  the  direction  cosine  matrix  (DCM)  Cp 
in  Equation  B.5  is  replaced  by  the  DCM  specifying  the  transformation  from  the 
body  to  the  navigation  frame  in  Equations  B.5  and  B.8.  This  DCM  is  a  function  of 
the  trajectory  followed  by  the  M  as  specified  in  Section  A. 9. 

•  The  altimeter  gains  A'l  and  I\2  which  appear  in  Figure  B.l  and  Equation  B.ll  are 
set  to  the  values  given  in  Table  B.3  for  the  M. 

•  The  sensor  error  models,  characterizing  the  vectors  e  Q  and  are  as  given  in 
Table  A. 3. 

•  The  white  noise  vector  is  non-zero  as  described  in  Subsection  B.8. 


Table  A.3:  M  INS  SENSOR  ERROR  MODELS'^ 


INSTRUMENT 

ERROR  SOURCE 

MODEL 

MODEL  PARAMETERS' 

Laser  Gyro 

Turn-on  Repeatability  Bias 
Bias  Drift  Rate 

Random  Drift  Rate** 

Scale  Factor 

Misalignment 

Bias 

Markov 

White  Noise 
Bias 

Bias 

cr  =  1.0  deg/hr 
cr  =0.1  deg/hr,  r  =  1  hr 

Q  =  (0.030  deg/v/h7)2 
cr  =  100  ppm 
<7  =  6  sec 

Accelerometer 

Turn-on  Repeatability  Bias 
Bias  #1 

Bicis  #2 

Scale  Factor 

Misalignment 

Bias 

Markov 

Markov 

Bi^ts 

Bias 

<7  =  1500  /ig 
<7  =  240  /ig,  r  =  60  min 
<7  =  120  /ig,  7=15  min 
<7  =500  ppm 
(7  =  20  sec 

Altimeter 

Bicts 

Scale  Factor 

Markov 

Bicis 

(7  =  150  m,  r  =  463000/1;  sec 
<7  =  0.03 

'’Source:  [Levinson  et  al.,  1977]  and  [Maybeck,  1977].  Error  characteristics  comparable  to  Sperry  SLIC- 
15  INS  with  Hamilton  Standard  accelerometer  model  ([Maybeck,  1976]  and  [Maybeck,  1977])  scaled  to 
SLIC-15  (Q-Flex  accelerometer)  bias  error  level. 

^Notation:  a  is  the  standard  deviation  of  bias  and  Markov  error  sources;  t  is  the  correlation  time 
of  Markov  error  sources;  Q  is  the  Q-matrix  (spectral  level,  [Gelb,  1974])  of  the  white  noise;  i;  is  the  M 
velocity  in  m/sec. 

*The  white  noise  random  drift  rate  is  modeled  as  a  first-order  Markov  with  r  =  A/2  and  cr^  =  Q/A 
where  A  is  the  sampling  interval  between  propagations  or  updates. 
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A.5  LP  INS  Model 

The  model  for  the  LP  strapdown  INS  is  given  by  Equation  B.l  of  Appendix  B  with  the 
following  modifications: 

•  Because  the  M  INS  is  a  strapdown  system,  the  direction  cosine  matrix  (DCM) 

in  Equation  B.5  is  replaced  by  the  DCM  specifying  the  transformation  from 
the  body  to  the  navigation  frame  in  Equations  B.5  and  B.8.  This  DCM  is  a  func¬ 
tion  of  the  trajectory  followed  by  the  LP  as  specified  in  Subsection  A. 3  (Equa¬ 
tions  A. 3,  A. 30.  A.42.  A. 72,  A. 125,  A. 137,  A. 168,  A. 190,  A.203). 

•  The  altimeter  gains  /\\  and  vvhich  appear  in  Figure  B.l  and  Equation  B.ll  are 
set  to  the  values  given  in  Table  B.3  for  the  LP. 

•  The  sensor  error  models,  characterizing  the  vectors  e  o  and  Skjs^,  are  as  given  in 
Table  A. 4. 

•  The  white  noise  vector  is  non-zero  as  described  in  Subsection  B.8. 


Table  A.4:  LP  INS  SENSOR  ERROR  MODELS^ 


INSTRUMENT 

ERROR  SOURCE 

MODEL 

MODEL  PARAMETERS'" 

Laser  Gyro 

Turn-on  Repeatability  Bias 
Random  Drift  Rate" 

Scale  Factor 

Misalignment 

Bias 

White  Noise 
Bias 

Bias 

(T  =  0.004  deg/hr 

Q  =  (0.004  deg/\/h7)2 

10  ppm 
cr  =  6  sec 

Accelerometer 

Turn-on  Repeatability  Bias 
Bias  #1 

Bias  #2 

Scale  Factor 

Misalignment 

Bi8ts 

Markov 

Markov 

Bias 

Bias 

<7  =  100  /ig 

cr  =  16  /ig,  7-  =  60  min 
cr  =  8  /ig,  7-  =  15  min 
cr  =200  ppm 
cr  =  4  sec 

Altimeter 

Bias 

Scale  Factor 

Markov 

Bias 

cr  =  150  m,  r  =  463000/i’  sec 
cr  =  0.03 

A.6  SP  INS  Model 

The  model  for  the  SP  strapdown  INS  is  given  by  Equation  B.l  of  Appendix  B  with  the 
following  modifications: 

^Source:  [Levinson,  1978]  and  [Maybeck,  1977].  Error  characteristics  comparable  to  Honeywell  LINS- 
0  INS  with  Hamilton  Standard  accelerometer  model  ([Maybeck,  1976]  and  [Maybeck,  1977])  scaled  to 
LINS-0  bias  error  level. 

'^Notation:  cr  is  the  standard  deviation  of  bias  and  Markov  error  sources;  r  is  the  correlation  time  of 
Markov  error  sources:  Q  is  the  Q-matrix  of  the  white  noise;  v  is  the  LP  velocity  in  m/sec. 

''The  white  noise  random  drift  rate  is  modeled  as  a  first-order  Markov  with  t  =  A/2  and  <t^  =  Q/A 
where  A  is  the  sampling  interval  between  propagations  or  updates. 
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•  Because  the  SP  INS  is  a  level- platform  system,  the  direction  cosine  matrix  (DCM) 

in  Equation  B.5  is  replaced  by  the  identity  matrix  in  Equations  B.5  and  B.8. 

•  The  altimeter  gains  A'l  and  A'2  which  appear  in  Figure  B.l  and  Equation  B.ll  are 
set  to  the  values  given  in  Table  B.3  for  the  SP. 

•  The  sensor  error  models,  characterizing  the  vectors  c,  a,  and  6h/i,,  are  as  given  in 
Table  A. 5 

•  The  white  noise  vector  is  zero  as  described  in  Subsection  B.8. 


Table  A.5:  SP  INS  SENSOR  ERROR  MODELS'^ 


INSTRUMENT 

ERROR  SOURCE 

MODEL 

MODEL  PARAMETERS*^ 

SDOF  Gyro 

G-Insensitive  Bias 

Bias 

cr  =  0,005  deg/hr 

G-,  G‘-Sensitive  Bias 

— 

Neglected*'' 

Bias  #1 

.Markov 

a  =  0.002  deg/hr.  r  =  60  min 

Bias  #2 

Markov 

cr  =  0.001  deg/hr,  r  =  15  min 

Scale  Factor 

Markov 

cr  =  0.0025  deg/hr  r  =  60  min 

Misalignment 

Bias 

a  —  0.2  sec 

Accelerometer 

Turn-on  Repeatability  Bias 

Bias 

<T  =  10  /ig 

Bias  #1 

Markov 

cr  —  Z  ng,  r  =  60  min 

Bias  #2 

Markov 

(7  =  2  ng,  r  =  15  min 

Scale  Factor 

— 

Neglected'^ 

Misalignment 

Bias 

(7  =  2  sec 

Altimeter 

Bias 

Markov 

(7  =  6  m,  r  =  30  sec 

Table  A. 6 


Table  A.6;  GRAVITY  ERROR  MODEL  FOR  SP  INS'^ 


ERROR  SOURCE 

SYMBOL 

.MODEL 

MODEL  PARAMETERS'** 

Meridian  Deflection  (about  East) 

Markov 

(7  =  26.0  X  10"'’  rad,  r  =  1.852  x  10'‘/u  sec 

Prime  Deflection  (about  North) 

'7 

Markov 

Gravity  Anomaly 

AG 

Markov 

'^Source:  Error  characteristics  comparable  to  high-accuracy  (conventional  gjTo)  model  in  [Mueller  et 
al.,  1977]  with:  gyro  Markov  biases  and  misalignments  from  Hamilton  Standard  model  ([Maybeck,  1976] 
and  [Maybeck,  1977])  scaled  to  the  gyro  bias  error  level;  and  Hamilton  Standard  accelerometer  model 
scaled  to  the  accelerometer  bias  error  level. 

'^Notation:  <t  is  the  standard  deviation  of  bieis  and  Markov  error  sources;  r  is  the  correlation  time  of 
Markov  error  sources, 

'"'SP  acceleration  is  neglected. 

'^Source:  [Maybeck,  1977]. 

'^Notation;  <t  is  the  standard  deviation  and  r  is  the  correlation  time  of  Markov  error  sources;  v  is  the 
magnitude  of  SP  velocity. 

'^Source:  [Perlmutter  et  al.,  1977]. 

*'* Uncorrelated  measurement  sequence. 
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Table  A. 7;  GPS  ERROR  MODEL  PARAMETERS*" 


PARA.MFTER 

PAR  A. MET  PR  VALUE 

Position  .Measurement  Std.  Dev.*® 

15  m 

Position  Velocity  Std.  Dev.*® 

0.1  ni/sec 

Update  Interval 

10  sec 

A. 7  M,  LP,  and  SP  Ground  Align  Model 

The  simulation  of  ground  alignment  has  three  steps: 

1.  Covariance  initialization 

2.  State  augmentation 

3.  Riccatti  equation  propagation. 

These  three  steps  are  described  in  the  following  three  paragraphs. 

Covariance  Initialization.  The  INS  covariance  (Pmins»  i.ns?  Aiins,  depending 
on  the  INS  under  consideration)  is  initialized  to  a  diagonal  matrix  inv  icative  of  the  errors 
in  the  approximate  initialization  entered  by  ground  personnel.  Table  A. 8  gives  the  RMS 
levels  of  the  first  nine  diagonal  entries  in  the  initial  covariance  matrix  for  all  thre-’  vehicles 
(M,  LP,  and  SP).  The  RMS  levels  of  the  other  diagonal  entries  tgyro.  accelerometer,  and 
altimeter  error  sources)  are  set  to  the  RMS  levels  listed  in  Tables  .A. 3.  i\.4.  and  A. 5. 


Table  A.8:  RMS  LEVELS  OF  INITIAL  INS  STATES*^ 


DEFI.MTIO.N 

RMS  LEVEL 

Attitude  Error  About  .N  Axis 

60  min 

cd.E 

Attitude  Error  ,\bout  E  Axis 

60  min 

S9.r> 

Attitude  Error  About  D  Axis 

300  min 

6L, 

Latitude  Rate  Error 

se. 

Longittide  Rate  Error 

6ti. 

Altitude  Rate  Error 

6L. 

Latitude  Error 

5  nr 

Longitude  Error 

5  min 

6h, 

Altitude  Error 

170  m 

State  Augmentation.  Ground  align  is  modeled  by  simulating  seven  noisy  measurements 
of  the  INS  state:  a  magnetic  heading  as  measured  with  a  flux  valve,  three  positions  (the 

^^Source:  [San  Giovanni,  1977].  Assumed  ground  alignment  location  (near  Norfolk  Va.):  Latitude 
North  =  37  deg;  longitude  West  =  76  deg;  altitude  =  3  ni. 

^“Notation:  indicates  M,  L  (for  LP),  or  .S  (for  SP). 
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approximately  known  position  of  the  aircraft  at  liome-base),  and  three  velocities  (indica¬ 
tive  of  wind  buffeting  of  a  stationary  aircraft).  The  error  models  for  these  measurements 
are  given  in  Table  .\.9. 


Table  .4.9:  GROUND  ALIGN  MEASUREMENT  AGCURACIES"^ 


MEASUREMENT 

MEASUREMENT  .MODEL 

MODEL  PARAMETERS- 

Heading 

Bias  -f  White  Noise 

^bias  ~  2 

^white  r.oise  —  min 

North  Position 

White  .Noise 

(7  =  3  m 

East  Position 

// 

If 

Down  Position 

If 

North  V'elocity 

White  .NoLse 

cr  =  0.005  m/sec 

East  Velocity 

It 

// 

Down  V'elocity 

n 

It 

The  magnetic  heading  error  model  includes  two  components:  a  bias  due  to  uncompen¬ 
sated  error  in  magnetic  variation;  and  a  white  noise  component  due  to  flux  valve  error. 
To  simulate  the  bias  component,  the  covariance  matrix  of  the  INS  needs  to  be  augmented 
with  an  additional  bias  state  having  the  RMS  accuracy  shown  in  Table  A. 9.  This  state  is 
removed  after  completion  of  the  ground  align  simulation. 

Riccatti  Equation  Propagation.  The  Riccatti  equation  is  propagated  for  a  10  min 
interval  with  measurements  every  30  sec  using  the  following  state-space  matrices; 

•  F  and  Q_  matrices  from  the  INS  error  models  for  the  M,  LP,  and  SP  described  in 
Subsections  A. 4,  A. 5,  and  A. 6,  each  with  an  additional  zero-row  and  zero-column  to 
model  the  bias  magnetic  heading  error  described  in  the  previous  paragraph.  These 
matrices  specify  the  state-space  equations 

•  Initial  covariance  matrix  as  described  in  ilie  Covariance  Initialization  paragraph 

•  Measurement  equation  of  the  form 


£*.  =  +  tlga  (A.221) 

where  the  entries  in  the  vector  correspond  to  the  seven  measurements  listed  in 
Table  A. 9 

•  //-Matrix  given  bv 

i£ga  =  [  //,a.  1  I  /4a3  ]  (A.222) 

^'Source:  [San  (novaiini.  1977] 

’^Notation:  <r  i.s  the  standard  deviation  of  the  bia.s  or  <iiscrete-time  white  noise 
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where: 
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1 

ii-^a.2  Q7x(dim{£}+dim{o}+l) 

■  1  ■ 

0 

0 


0 

0 
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(A.223) 


(A.224) 


(A.225) 


The  blocks  within  H are  as  follows.  The  first  row  of  and  the  first  row  of 
model  the  heading  measurement  as  a  linear  combination  of  the  heading  error  state 
(e.g.,  ^^md)  and  the  heading  instrument  bias  (to  which  white  noise  is  added  via 
the  first  entry  in  v^^).  The  other  non-zero  entries  in  model  the  measurement 
of  position  and  velocity.  The  //ga2  zero  because  the  gyro,  accelerometer,  and 
altimeter  error  states  are  not  directly  measured. 


•  The  /f-.Matrix  is  specified  by  the  white  noise  entries  listed  in  Table  A. 9. 


A. 8  M  Transfer  Align  Model 

The  transfer-align  model  is  composed  of  two  parts: 

•  .\  state-space  model  (dynamics  and  measurement  equations)  which  specifies  the 
transfer-align  Kalman  filter 

•  .An  LP  maneuver  model  (deterministic)  which  specifies  the  trajectory  followed  by 
the  LP  during  transfer-alignment. 

These  two  models  are  described  in  Subsections  A. 8.1  and  A. 8. 2. 

A. 8.1  State-Space  Transfer- Align  Model 

Background  The  objective  of  the  development  that  follows  is  to  obtain  a  state-space 
model  for  the  transfer-alignment  measurements,  Z_n\ 

Kta  =  E-ta  K-ta  +  H^T/t 

Z.TA  -  ILta  E-TA  +  V.TA  ■  (A. 226) 
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The  variables  in  these  equations  can  be  divided  into  four  groups  as 
variables: 


follows.  State  equation 


£-lp  *= 
— 

E-TA  ~ 


^LP 

LP  INS  error  state  vector  specified  in  Table  3.4 

M  INS  error  state  vector  specified  in  Table  3.8 

F-matrix 

Elp  0 
0  F 


(A.227) 


W 


TA 


St 

White-noise  vector 

IUlp 
UIm 


(A.228) 


(A.229) 


where  F_ip  and  are  the  F-matrices  of  the  LP  and  M  INS  appearing  in  Equation  B.l, 
and  w^p  and  are  the  corresponding  white-noise  vectors.  Measurements: 


2-ta.p 

Z.TA.V 


Eta.p 


=  Position  difference  measurement 


Z 


TA.v  — 


Pm 


Piplst 


A"  I 

'  LPlA/ 


Pm  ~  PlpIm 

Velocity  difference  measurement 
^\vf  “  ^'1p\m 

Position  read-out  of  M  INS  in  the  n-frame 

Position  of  M  based  on  read-out  of  LP  INS  in  the  n-frame 

Velocity  read-out  of  M  INS  in  the  n-frame 

Velocity  of  M  based  on  read-out  of  LP  INS  in  the  n-fram.e. 


(A.230) 

(A.231) 

(A.232) 


//-matrix: 


H 


■TA 


Eta.p 

1L.TA.V 


(A.233) 


H 


T  A  ,p 
TA,v 


—  3  X  [dimj^f^p}  +  dim{£,\/}]  matrix  specifying  the  position  measurement 
=  .3  X  [dimjx//)}  -|-  dim{x\/}]  matrix  specifying  the  velocity  measurement. 


Measurement  noise: 


-TA  - 


V 


V 


TA.p 


-t-TA.i’ 


(A.234) 

V_TA.p  —  3x1  position  measurement  noise  vector 

—  3x1  velocity  measurement  noise  vector. 

4  he  position  and  velocity  measurement  noise  is  specified  by  the  covariance  matrix 

&,,  =  (A.235) 
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The  equations  listed  above  specify  a  Kalman  filter  which  estimates  the  state  of  the  M 
INS  based  on  measurements  generated  by  subtracting  (appropriately)  the  difference  in  the 
position  and  velocity  read-outs  of  the  M  and  LP  INSs.^^  The  accuracy  of  the  estimates 
provided  by  the  Kalman  filter  is  specified  by  the  error  covariance  matrix  of  the  state 

P-TA  =  E{{X:f  .x  —  ^ta)(X.ta  ~  Kta)^}  (A. 236) 

(X.TA  ‘s  the  Kalman  estimate).  This  matrix  is  obtained  by  propagating  the  associated 
Riccatti  equation  {[Gelb,  1974]).  From  P:rA^  Ihe  error  covariance  matrix  for  the  M  at  the 
end  of  the  transfer  alignment  is  obtained  by  a  CPC^  transformation; 

Zw(^END  ta)  =  CPr,^  (A.237) 

where 

—  ~  ]  ■  (A. 238) 

The  computation  of  the  covariance  defined  in  Equation  A.237  is  the  objective  of  the 
transfer-align  simulation. 

Input  Parameters  —  The  following  parameters  are  set  before  the  computation  algo¬ 
rithm  is  begun: 

•  The  time  at  which  transfer-alignment  begins.  teEGlNTA-  (Note:  the  time  at  which 
transfer-alignment  ends,  <endta  is  the  time  at  which  the  maneuver  described  in 
Subsection  .•\.8.2  ends  and  consecjuently  is  not  an  input  parameter.) 

•  The  vector  from  the  LP  INS  to  the  M  INS,  called  lever-arm,  when  the  LP  is  sta¬ 
tionary  (i.e..  when  the  wings  are  not  “flapping’’  or  the  body  of  the  LP  is  not  being 
deformed  in  any  way)  expressed  in  the  bip-h&me: 

—2  m 

±4  m  .  (A.239) 

0.5  m 

The  sign  selection  in  ±4  depends  on  whether  the  M  is  under  the  right  wing  (-|-)  or 
the  left  wing  (  — ). 

•  The  covariance  of  the  uncertainty,  in  produced  by  aircraft  deformation 

during  flight: 

■  (0.2  m)'^  0  0 

Ela.p^  0  (0.2  m)2  0  .  (A.240) 

0  0  (0.6  m)^ 

The  covariance  values  indicate  that  the  greatest  uncertainty  is  in  the  "vertical” 
motion  of  the  wings. 

^^The  statp  of  the  LP  INS  i.s  also  estimated  but  is  not  expected  to  be  significantly  affected  because  of 
the  better  accuracy  of  the  LP  INS  relative  to  the  M  IN.S. 
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•  The  covariance  of  the  uncertainty,  of  the  velocity  of  M  relative  to  the  origin 

of  the  6^p-frame  in  6^p-frame  coordinates.  This  velocity  is  produced  by  aircraft 
deformations  while  in-flight  and  is  taken  to  be 


£-La.p 


P-LA.v 

0.5  sec 


(.4.241) 


to  reflect  the  time  taken  by  a  one-sigma  position  excursion. 


.Assumptions  —  The  following  simplifying  assumptions  provide  an  approximate  model 
for  the  deformation  motion  of  the  aircraft: 


•  The  vectors  and  are  white  noise  processes  and  component-wise  uncorre¬ 
lated  when  sampled  at  5  sec  intervals 

•  The  vectors  and  are  uncorrelated  when  sampled  at  5  sec  intervals.  (Basis: 

for  any  value  of  a  component  of  the  sign  of  the  corresponding  is  equally 

likely  to  be  -f  or  — .) 


Computation  Algorithm  — ■  The  objective  of  the  computation  algorithm  is  to  compute 

(^END  TA  )•  A  seven-step  procedure  is  followed  based  on  the  approximate  analysis 
suggested  in  [Farrell,  1976]  (also  [Perlmutter  et  ah,  1977]).  A  more  exact  (and  more 
complicated)  development  is  given  in  [Baziw  and  Leondes,  1972a]  and  [Baziw  and  Leondes, 
1972b]). 

/.  Increment  time:  t  =  t  +  b  sec  while  tgEGlNTA  ^  t  ^  ^ENDTA 

2.  Compute  the  state-space  model  variables,  and  the  covariance  of  W-ta-  The 
matrix  F_j^  is  computed  using  Equation  A.228  where  Fiip  and  are  the  F-matrices 
of  the  LP  and  .M  INS  appearing  in  Equation  B.l.  The  (^-matrix  of  W is  similarly 
computed  from  the  Q-matrices  of  and  Wxt-  Both  of  these  quantities  depend  on  the 
trajectory  being  followed  by  the  LP  at  time  /. 

3.  Compute  the  position-difference  measurement  matrix,  To  form  the  difference- 

position  measurement,  the  position  read-out  of  the  LP  INS  is  subtracted  from  that  of  the 
M  INS.  This  subtraction  is  accomplished  by  the  matrix  Kta.p  which  multiplies  the  com¬ 
posite  state  vector  Xj  <: 

M.TA.P  =  [  ~{ii-TA,p,LP\  +  iLTA.p.LP2)  \  Kta.pM  ]  (A. 242) 

If  the  LP  and  M  INSs  were  colocated,  the  subtraction  is  accomplished  by  multiplying 
the  state  vectors  of  the  M  and  LP  by  the  matrices  ILta.p,m  ^nd  ILta,p,lp\  respectively, 
and  subtracting.  These  matrices,  which  convert  latitude/longitude  to  NED  position  by 
taking  into  account  the  spherical  shape  of  the  Earth,  are  shown  in  Figures  A.l  and  A. 2 
(the  matrices  are  almost  identical).  Because  the  INSs  are  not  colocated,  the  effect  of  the 
lever-arm  needs  to  be  taken  into  account  by  the  product  ILta.p,lP2-^lp  with  the  matrix 
Kta.  P.LP2  defined  in  Figure  A. 3.  The  dummy  variables  di,  d^^  and  dj,  used  in  Figure  A. 3 
are  defined  by 

d\ 

^2 
d.3 


=  -CIpIa 


(A.243) 
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03x3 

—  R(^i  sin  L 

Rq  cos  L 

^  cos  L 

Q3X  (dim{x£^p}  — 9) 

0 

0 

-1 

Figure  A.l;  Matrix  Kta,p,lpi 


0 

L 

OsxS 

03X3 

—  R^i sin  L 

R^  cos  L 

(  cos  L 

Q3x(dim{xj^,}-9) 

0 

0 

-1 

Figure  A.2:  Matrix  ILta.pM 


0 

ds 

CM 

■33 

1 

—dj 

0 

Q3x(clini{xj^p}  — 3) 

C?2 

-d, 

0 

Figure  A. 3:  Matrix  ILta.p,lP2 
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where  is  the  lever-arm  vector  (Equation  A. 239)  and  b  is  the  LP  6-frame. 

4-  Compute  the  velocity-difference  measurement  matrix,  The  velocity  mea¬ 

surement  matrix,  H ta.v-  is  the  sum  of  three  terms; 

H-TA.v  —  ILtA,v\  +  tLrA.vl  +  M.TA.V3-  (A. 244) 

These  three  terms  are  as  follows. 

The  first  term,  H_ta,v\^  forms  the  difference  between  the  velocity  read-out  of  the  M 
and  LP  INSs.  If  the  M  and  the  LP  INSs  were  colocated,  this  term  would  be  the  only 
one  required  in  Equation  A. 244.  To  form  this  difference,  the  longitude-,  latitude-,  and 
altitude-rate  entries  in  the  .\I  and  LP  INS  states  have  to  be  multiplied  by  factors  containing 
the  radius  of  the  Earth  and  then  subtracted.  These  operations  are  implemented  by 

H-TAM  =  [  Uta.vI.LP  i  H-TA.vlM  ]  (A. 245) 

where  the  left/right  partitions  (which  multiply  the  LP/M  states)  are  given  in  Figures  A. 4 
and  A. 5.  In  the  figures,  /'v,  ve,  and  L  are  the  North-velocity,  East-Velocity,  and  latitude 
of  the  LP  as  given,  for  example,  by  Equations  .4.92  to  A. 94  for  the  Right-Turn/Left-Turn 
LP  motion  event  (Subsection  A. 3. 4)  and  similarly  for  other  events. 
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Figure  .4.4:  Matrix  JLta.v\.lp 
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Figure  A. 5;  Matrix  ILta.vim 

The  second  term,  ILta.vi^  into  account  the  error  in  estimating  the  angular  veloc¬ 
ity  of  the  lever-arm  based  on  the  attitude  read-out  of  the  LP  INS.  (The  angular  velocity  of 
the  lever-arm  contributes  to  the  velocity  of  the  point  where  the  M  INS  is  located.)  This  er¬ 
ror  is  computed  by  “multiplying"  (appropriately)  the  attitude  error  rates  of  the  LP  (60ln. 
and  Table  3.8)  by  the  entries  in  the  lever  arm  vector,  p^^  (Equation  A. 239): 

U-TA.vl  —  \  !lE.n  IlE-ne  HKna  HF-nh  \  Q.^xdim{TJ^, }  ]  (A. 246) 
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where  the  F-matrix  blocks  are  used  to  form  the  attitude  error  rates  as  in  Equation  B.l. 
The  dummy  matrix  F  selects  the  attitude  error  rates  from  n  (Equation  B.l)  and  multiplies 
by  the  lever-arm  vector: 


D  = 


C,"  and  Ci 

1-3x9 


CIEC%„ 

As  in  Section  A. 3 


1-3x3 


-P3 


P2 


0 


U3x3  U.3X3 


0. 


P3 

0 


-P2 


Pi 


-Pi  0 


Pi 
P2 

L  P3  J 


Pla- 


(A.247) 

(A.248) 

(A.249) 


(A.250) 


(A.251) 


The  third  term,  ILxa,v3^  takes  into  account  the  effect  of  attitude  errors  of  the  LP  in 
determining  the  orientation  of  the  angular  velocity  vector  of  the  LP.  This  matrix  acts  ou 
the  attitude  errors  of  the  LP  according  to 


(A.252) 


0 

da 

-d2 

IL.TA,v3  — 

—da 

0 

di 

Qsx  (dim{£  p  } -3) 

Q.3xdim{ij^j } 

_ 1 

— di 

0 

where  the  dummy  variables  di,  ^2,  and  are  defined  by 


di 

^2 

da 


(A.253) 


In  this  equation,  is  the  matrix  of  angular  rates  with  respect  to  the  u-frame, 

[  n  -R  Q 


0  -R 

R  0  -P  (A.254) 

[-Q  P  0  . 

where  P,  Q,  and  R  are  as  defined  in  Section  A. 3. 

5.  Compute  the  position  and  velocity  measurement  noise  covariance,  Rxa  The  mea¬ 
surement  noise  originates  from  the  uncertainties  in  measuring  the  position  and  velocity 
of  the  lever-arm,  and  These  uncertainties,  with  covariance  given  by  Equa¬ 

tions  A. 240  and  A. 241,  affects  the  position  and  velocity  difference  meaisurements  according 
to 


]iLta  = 


Y.ta,p 

y-TA,v 


=  -D 


^P'^LA 

^^LA 


(A.255) 

(A.256) 
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where  the  matrix  D, 


D 


CTIF. 


0.3 


nb 


x3 
'^b 


(A.257) 


accounts  for  two  effects:  ( 1 )  the  transformation  from  the  f>-frame  to  the  n-frame;  and  (2) 
the  effect  of  the  position  uncertainty  on  velocity  error  because  of  the  angular  rate  of  the 

LP,  K^-  .  '  '  .  . 

Equations  A. 256  and  A.257  indicate  that  the  covariance  matrix  of  the  position  and 
velocity  difference  measurement  noise  is  given  by  (Equation  A. 235) 


Rta 


D 


(A.258) 


RlA.p  0.3x3 
0.3x3  P-LA.v 

where  the  diagonal  entries  are  given  in  Equations  A. 240  and  A. 241. 

6.  Propagate  the  Riccatti  equation:  A  continuous-discrete  propagate/update  is  per¬ 
formed  as  described  in  [Gelb,  1974]. 

7.  End  iteration:  If  done  (t  =  tENDTA)>  compute  £A/(tENDTA)  from  Equation  .A. 237; 
else  goto  Step  1. 


A. 8. 2  Transfer- Align  LP  Trajectory  Model 

Background  —  The  transfer-align  maneuver  has  three  segments  ([Perlmutter  et  ah,  1977], 
[Schmidt.  1978]): 

1.  An  initial  constant- velocity  segment  for  the  calibration  of  level  attitude  and  level 
gyro  bias 

2.  An  S-maneuver  which  produces  lateral  acceleration  and  azimuth  changes  for  the 
calibration  of  azimuth  and  accelerometer  bias 

3.  A  final  constant-velocity  segment  for  the  calibration  of  level  attitude  errors  which 
may  be  excited  by  the  S-maneuver. 

These  segments  are  specified  in  the  following  paragraphs  in  terms  of  the  LP  “motion 
events"  described  in  Section  A. 3. 

Initial  Constant- Velocity  Segment  —  The  LP  executes  a  “Level  Flight  at  Constant 
Velocity”  trajectory  (Subsection  A. 3.3)  for  90  sec. 

S-Maneuver  Segment  —  The  LP  executes  a  sequence  of  four  “Right-Turn  /  Left-Turn" 
trajectories  (Subsection  A. 3. 4)  as  follows  ((/’begin  ta  is  the  initial  LP  heading): 

•  Right-turn  at  0.65  y  to  a  heading  (/’begin  ta  +  '^0  deg 

•  Left-turn  at  0.65  y  to  a  heading  t^’BEGiN  ta  “  ^0  deg 

•  Right-turn  at  0.65  y  to  a  heading  (/’begin  ta  +  80  deg 

•  Left-turn  at  0.65  y  to  a  heading  V’begin  ta  • 

Final  Constant-Velocity  Segment  —  The  LP  executes  a  “Level  Flight  at  Constant 
Velocity”  trajectory  (Subsection  A. 3.3)  for  30  sec. 

During  all  three  of  these  segments,  the  calculations  described  in  Subsection  A. 8.1  are 
executed. 
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A. 9  M  Mid-Course  Guidance  Model 

A. 9.1  Introduction 

The  guidance  model  has  two  objectives: 

•  To  compute  the  mean  and  covariance  of  the  M  position  and  velocity  at  handover 

•  To  compute  the  mean  and  covariance  of  the  T  position  and  velocity  at  handover. 

These  cjuantities  determine  the  outcome  of  the  endgame. 

The  algorithms  to  compute  these  quantities  are  developed  in  the  following  subsections 
as  follows: 

•  Subsection  .A. 9. 2  lists  the  inputs  to  the  guidance  algorithm 

•  Subsection  A. 9. 3  lists  the  outputs  of  the  guidance  algorithm 

•  Subsection  A. 9. 4  provides  an  overview  of  the  algorithm  used  to  compute  the  outputs 
from  the  inputs 

•  Subsections  A. 9. 5  to  A. 9. 11  describe  the  details  of  the  algorithm. 

A. 9. 2  Guidance  Inputs 

The  inputs  to  the  guidance  algorithm  and  their  source  are  as  follows. 

M  true  position  and  velocity  at  launch  (pm(<launch),  ^m(^launch)):  These  quantities 
are  computed  from  the  true  LP  position  and  velocity  according  to: 

Pm(^launch)  =  pLp(<launch)  +  (A. 259) 

t’i/l^LAUNCH)  =  ^IpC^launch)  (A. 260) 

where  p^^  is  the  lever  arm  vector  (Equation  A.239).  The  LP  position  and  velocity  (pip 
and  Vip)  and  the  transformation  are  specified  by  the  LP  trajectory  events  prior  to 
launch  as  described  in  Section  A. 3.  The  addition  of  n-frame  and  Tframe  quantities  in 
Equation  A. 259  is  justified  because  the  origin  of  the  l-frame  is  assumed  to  be  near  the 
launch  point. 

M  INS  error  covariance  matrix  at  launch  (£A/(fLAUNCH )):  This  matrix,  defined  by 

Zm(^LAUNCh)  =  £’{l.M(^LAUNCH)^Af(<LAUNCH)^}  (A. 261) 

=  M  INS  state  vector  (Table  3.4), 

is  available  from  the  propagation  of  the  M  INS  covariance  from  the  end  of  the  transfer 
alignment  procedure  (Section  A. 8)  to  the  time  of  launch. 

T  mean  position  and  velocity  at  launch  (pj(/launch),  ^^’H^launch)):  The  mean  T 
position  and  velocity  is  the  deterministic  component  of  T  motion  as  described  in  Subsec¬ 
tion  A. 1.2.  This  component  is  specified  by  the  input  parameters  listed  in  Table  A.l. 
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T  position  and  velocity  estimation  error  covariance  from  SP  tracking  filter  at  to  (Ptr  pv(lo))' 
This  matrix,  defined  by  Equation  A. 366,  is  computed  according  to  Equation  A. 375.  (The 
time  <0  is  defined  on  page  66.) 

Miscellaneous  inputs:  The  following  parameters  are  inputs  to  the  simulation: 

Rm  =  Range  of  M  (indicative  of  M  fuel/aerodynamic  characteristics) 

=  50  km  (A. 262) 

^SEEKER  ACQ  =  Seeker  acquisition  range^'* 

=  8  km  (A.263) 

=  M  cruising  speed 

=  5  M  (A.264) 

<2launch  =  M  acceleration  at  launch 

=  15  g  (A.265) 

«/,max  =  M  maximum  available  level  (North/East)  acceleration 

=  10  g  (A.266) 

Oj.max  =  M  maximum  available  vertical  acceleration 

=  10  g  (A.267) 

^max  =  Measure  of  available  M  maneuverability 

=  600  g  •  sec.  (A. 268) 

The  last  parameter  in  the  above  list,  maneuverability,  is  a  measure  of  the  capability 
of  the  M  to  execute  corrective  maneuvers  according  to  the  formula 

"i  =  i«/k/  +  (A.269) 

where 

n,  =  Constant  acceleration  applied  in  the  level  direction 
=  Constant  acceleration  applied  in  the  vertical  direction 
Ti  =  Time  interval  during  which  at  is  applied 
Tj  =  Time  interval  during  which  a,  is  applied. 

Maneuvers  during  flyout  are  required  to  obey  the  feasibility  constraint  Af  <  Large 

accelerations  sustained  for  a  long  time  interval  would  tend  to  exceed  the  maximum  ma¬ 
neuver  capability  m^ax- 

A. 9. 3  Guidance  Outputs 

The  outputs  produced  by  the  guidance  model  are  as  follows. 

Zero-error  handover  time  (ino)'-  This  quantity  is  the  time  at  which  handover  occurs 
in  the  absence  of  errors. 

the  presence  of  errors,  the  handover  time  is  a  random  variable  as  described  below. 
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Means: 

Pri^Ho)  =  Mean  T  position  at  tj^o 
I'ritHo)  =  Mean  T  velocity  at  tuo 
p\i{hlo)  —  Mean  M  position  at  i^o 
=  Mean  M  velocity  at  t^jo- 

Covariances:  Output  covariances  are  identified  by  the  subscript  ‘‘Z,’’  to  indicate  a 
measure  of  the  variability  of  the  physical  location  (actually,  position  and  velocity)  of  the 
M  or  T.  These  covariances  are  different  from  estimation  covariances  which  measure  the 
variability  of  numbers  stored  in  a  computer. 

Two  output  location  covariances  are  computed: 

Pl.t,pA  hio)  ~  T  position  and  velocity  covariance  at  t^o 
Pi.M.pvC ho)  =  position  and  velocity  covariance  at  tno- 

The  first  of  these  matrices,  PL.T.pv(h{o)<  obtained  from  a  CPC^  transformation  of  the 
covariance  of  the  T  random  motion  (Singer)  model  (described  in  Subsection  A. 1.2).  The 
second  matrix.  PL.\f.pv{iHo),  is  the  sum  of  two  terms:  one  term  is  caused  by  guidance 
uncertainty  (as  described  below):  the  other  term  represents  uncertainty  in  M  motion 
(Singer  model  described  in  Section  .A. 2). 

A. 9. 4  Guidance  Algorithm  Overview 

The  procedure  for  computing  the  output  quantities  from  the  input  quantities  is  divided 
into  seven  steps  as  follows: 

1.  Propagation  from  ^launch  fo  ^o-  The  input  quantities  in  Equations  .A. 259.  .A. 260. 
and  .A. 261  are  propagated  from  the  time  of  launch  to  the  time  /q  at  which  the  M 
achieves  its  cruise  speed.  .All  guidance  computations  are  assumed  to  begin  at  to- 
This  step  is  described  in  Subsection  A. 9. -5. 

2.  Computation  of  mean  trajectories:  The  trajectories  of  the  M  and  T  from  launch  to 
handover  are  computed  in  the  absence  of  any  random  effects  (which  in  actuality  are 
produced  by  instrument  errors  and  trajectory  fluctuations).  This  step  is  described 
in  Subsection  A. 9. 6. 

3.  Feasibility  test:  The  mean  trajectories  are  tested  to  determine  if  an  intercept  can 
occur  in  the  absence  of  errors  and  other  random  fluctuations.  If  an  intercept  is 
feasible  in  this  ideal  case,  then  the  linearized  error  analysis  described  in  Steps  2  to 
6  is  executed.  Otherwise.  i<ne  of  the  following  actions  is  executed: 

•  The  simulation  terminates,  indicating  that  a  change  in  the  input  parameters 
is  necessary  to  insure  a  geometry  that  makes  intercepts  possible 
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•  One  of  the  guidance  model  input  parameters  listed  in  Subsection  A. 9. 2  is  mod¬ 
ified  and  Steps  1  and  2  are  executed  again.*® 

This  step  is  described  in  Subsection  A.9.7. 

4.  Initialization  of  the  flyout  guidance  state  vector  covariance:  The  flyout  guidance 
state  vector,  x_q,  contains  all  the  relevant  random  quantities  from  which  the  M 
output  covariance  is  computed.  The  covariance  of  this  vector  is  initialized  at  a 
time  to  (defined  below)  based  on  the  navigation  and  tracking  errors.  This  step  is 
described  in  Section  A. 9. 8. 

■5.  Propagation  of  flyout  guidance  covariance:  The  covariance  of  ^  is  propagated  from 
to  to  the  mean  handover  time  i^jo-  This  step  is  described  in  Subsection  A. 9. 9. 

6.  Computation  of  M  Location  Covariance:  The  matrix  Plj.p\j[Iho)  is  computed  from 
the  covariance  of  Xq  and  the  M  Singer  motion  model.  This  step  is  described  in 
Subsection  .4.9.10. 

7.  Computation  of  T  Location  Covariance:  The  matrix  of  Pl.m.pvCho)  is  computed 
from  the  T  Singer  motion  model.  This  step  is  described  in  Subsection  .4.9.11. 

The  M  trajectory  is  computed  based  on  the  following  assumptions: 

•  .4  constant  three-dimensional  acceleration  is  applied  to  M  starting  at  time  to  (a 
deterministic  quantity)  and  ending  at  the  hando%'er  time  tj^o  (a  random  variable, 
defined  below) 

•  The  acceleration  levels  are  computed  so  that  an  intercept  occurs  at  time  t//Q  -f  tj 
where  t^  (a  deterministic  quantity)  is  an  estimate  of  the  duration  of  the  endgame 

•  The  applied  acceleration  has  two  components:  level  and  vertical.  Both  components 
are  assumed  to  be  orthogonal  to  the  estimated  velocity  of  the  M  at  to- 

The  "guidance  law"  defined  by  these  assumptions  produces  an  intercept  in  the  absence  of 
errors  and  T  maneuvers  without  any  further  M  maneuvering  during  the  endgame.  In  the 
presence  of  errors,  the  endgame  maneuvering  counteracts  the  flyout  (launch  to  hando%'er) 
guidance  errors. 

A. 9. 5  Propagate  from  /launch  to  /o 

The  first  step  in  the  guidance  algorithm  propagates  the  input  variables  listed  in  Subsec¬ 
tion  .4.9.2  from  the  time  of  launch  (/uainch)  fo  the  time  (to)  when  the  M  achieves  its 
cruising  speed  (V\/).  Time  to  is  assumed  to  be  the  starting  point  for  all  guidance  com¬ 
putations:  lateral  and  vertical  accelerations  to  achieve  an  intercept  are  applied  only  after 
the  M  has  achieved  its  cruising  speed.  Input  quantities  are  propagated  to  to  as  follows. 

^'’For  example,  suppose  the  mean  trajectory  is  unfeasible  because  of  insufficient  maneuvering  time 
during  flyout.  By  reducing  the  acquisition  range  ffsEEKER  acq  additional  flyout  time  is  provided  at  the 
expense  of  less  time  during  endgame. 
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M  true  position  atid  vdocity  at  launch  (/J\/(/launch )•  1’\/(^launch)):  The?'’  variables, 
computed  according  to  Equations  A. 259  and  A. 260.  are  propagated  to  to  via  a  ‘'Change 
of  Speed’’  trajectory  event  as  described  in  Subsection  A  .3  6.  The  input  parameters  to  this 
event  are  the  final  velocity  and  the  magnitude  of  t'ae  level  acceleration.  Values  for  these 
parameters  are  given  in  Equations  .A. 261  and  A. 265. 

M  INS  state  vector  covariance  T,\/(/laun'CII E  The  covarian'  ..f  the  M  INS  state  vector 
(Equation  .A. 261)  are  propagated  from  ^launch)  to  to  according  to  the  M  IN’S  dynamics 
(Section  .A.4). 

T  mean  position  and  velocity  at  launch  (px(fLAUNCH)^  i’f(^LAU.\CH )):  The  mean  T 
position  and  velocity  is  the  deterministic  component  of  T  motion  as  described  in  Subsec¬ 
tion  .A. 1.2.  This  component  is  specified  by  the  input  parameters  listed  in  Table  ,A.l. 

Tracking  position  and  velocity  error  covariance  {P.!  R,pv{to))'-  This  uiaiilx  is  already 
available  at  to,  making  propagation  unnecessary. 


A. 9. 6  Compute  Mean  Trajectories 

The  second  step  in  the  guidance  algorithm  computes  the  mean  trajectories  followed  by  the 
M  and  the  T.  The  mean  .M  trajectory  is  the  trajectory  followed  by  the  M  in  th''  absence 
of  any  errors.  The  mean  (predicted)  T  trajectory  is  the  trajectory  followed  by  the  T  in 
the  absence  of  maneuvers  after  to-  To  compute  these  trajectories,  eight  steps  are  followed. 

I.  Compute  the  closing  velocity  fV  'c)‘  The  closing  velocity  at  to  is  the  magnitude  of 
the  difference  between  the  velocities  of  the  T  and  the  M: 

Vc  =  —  Vv/(^o)||-  (,A.270) 


2.  Compute  the  duration  of  the  endgame  (t^):  The  duration  of  the  endgame  is  defined 
to  be 

,  A  /?SteKERACQ 

te^  - 77 - (A.2ll) 

Vc 

This  definition  implies  that  the  endgame  begins  as  soon  as  the  seeker  is  able  to  acquire 
the  target. 

3.  Compute  the  mean  acceleration  interval  (f,d:  The  mean  acceleration  is  interva.  is 
computed  to  achieve  an  intercept  in  the  absence  of  errors: 


where 


( Axo  —  r  Ai/o)  +  /e(  Arvo  ~  Ai’yo) 
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■fAfo  —  -fro 

(A. 275) 
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After  handover:  For  tffo  ^  i  ^  t/,  where  tj  is  the  mean  intercept  time.  ti  =  <//o  4-  tf.: 

p!v/(0  =  p\i{hio)  +  <’a/(0/o)(^  —  hio)-  (A.  294) 

8.  Compute  the  mean  predicted  position  of  T:  The  position  of  T  if  the  M  does  not 
maneuver  after  time  /q  is  given  by: 

PT,predicted(0  =  Pt(^o)  +  ~  ^o)i  (A. 295) 

for  <0  <  i'  <  t;. 

A. 9. 7  Test  Feasibility  of  Intercept 

The  third  step  in  the  guidance  algorithm  is  to  test  the  feasibility  of  an  intercept  in  the 
absence  of  any  errors.  .An  intercept  is  considered  feasible  if  the  mean  trajectories  are  such 
that  the  following  conditions  hold; 

1.  The  length  of  the  acceleration  interval  is  realizable: 

f^>0.  (A.296) 

2.  The  maximum  accelerations  are  not  exceeded; 

11^(11  ^ 

(dr(  "C:  d;,,nax- 

3.  The  maximum  maneuverability  is  not  exceeded: 

(||a<ll  +  |di|)fa.<  ”?max-  (A. 299) 

4.  An  intercept  is  achieved  in  the  mean; 

p\i(h)  ~  Fr.pro<ii((ea(^t)-  (A. 300) 

(  Note:  (his  <'(|uation  needs  to  ludd  only  within  numerical  round-off  error;  e.g.,  to 
within  four  significant  digits.) 

If  an  intercept  is  unfeasible  in  the  mean,  then  tiie  deterministic  LP  adid  T  trajectories 
are  not  likely  to  result  in  a  significant  probability  of  intercept.*'  For  these  cases,  an 
analysis  of  the  flyout  guidance  error  lacks  practical  significance.  Consequently,  if  the 
intercept  is  tmfeasible.  the  simulation  should  take  one  of  the  two  following  courses  of 
action; 

•  Exit  (after  printing  a  suitable  message) 

•  C'hange  one  of  the  giiidance  mod('l  input  parameters,  re-compute  the  mean  trajec¬ 
tories.  and  rc'-try  tiie  feasibility  test. 

^^Kvpn  it  the  mtetrept  i.s  fea.siiile.  howevrr,  sfime  of  the  sarnpli'  [lat  tis  may  rpsnit  in  unfeasible  intercepts 
because  the  tails  of  the  (iaiissian  distribution  e.xtemi  to  infinity 


(A.297) 

(A.298) 
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A. 9. 8  Compute  Initial  Mid-Course  Guidance  Covariance,  Pcito) 

Background  -  The  fourth  step  in  the  guidance  algorithm  begins  the  evaluation  of  the 
random  perturbations  on  the  mean  M  and  T  locations  at  handover.  These  perturbations 
are  caused  by  random  errors;  consequently,  variables  that  include  random  components 


need  to  be  defined  as  follows: 

PAf(0 

= 

Pa/(0  + 

(A.301) 

= 

Position  read-out  of  the  M  IN'S 

— 

(A.302) 

= 

Velocity  read-out  of  the  M  INS 

Pri^o) 

= 

Pt(^o)  + 

(A.303) 

= 

Estimate  of  T  position  obtained  from  the  SP  tracking  filter 

= 

)  T 

(A.304) 

= 

Estimate  of  T  velocity  obtained  from  the  SP  tracking  filter 

= 

^a.c  T 

(A.305) 

= 

Computed  duration  of  applied  acceleration 

= 

d;,c  + 

(A.306) 

= 

Computed  level  (North/East)  acceleration  (2-dimensionai  vector) 

^  z  ,c 

= 

"t"  ^^Z,C 

(A.307) 

= 

Computed  vertical  (down)  acceleration. 

The  notation 

used  in  these  equations  is  as  follows: 

•  Quantities  which  include  errors  are  identified  by  a  '‘hat’’  (e.g., 

•  Errors  are  identified  by  the  prefix 

•  M  ean  error-free  (juantities  are  identified  by  an  over-bar  or  by  the  absence  of  a  “hat  ’ 
or  d 

•  The  subscript  “c"  identifies  compH/cd  quantities: 

-  The  computed  accelerations  (u/^  and  d. ,-)  differ  from  the  resulting  acceleration 
by  the  misalignment  of  the  M  INS.  Other  differences  between  computed  and 
resulting  accelerations  (such  as  autopilot  inaccuracies  and  delays)  are  neglected 

-  The  computed  duration  of  the  acceleration  interval  (fac)  differs  from  the  re¬ 
sulting  duration  liecaiuse  of  clock  and  autopilot  inaccura.cies.  These  differences 
are  neglected. 

‘’^Thi.s  notation,  often  found  in  the  navigation  literature  (e  g.,  [Hrilting,  1071]),  differs  from  the  notation 
used  in  the  estimation  literature  (e  g.,  [Gelb,  1()71]1  where  "hat.s"  identify  estimates. 
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The  errors  quantities  defined  in  Equations  A. 301  to  A. 307  are  included  in  the  flyout 
guidance  state  vector,  which  has  entries  as  defined  in  Table  3.5  of  Section  3.7.  In  the 
following  paragraphs  equations  are  given  for  the  "initial"  covariance  of  Xq: 

—  E{.r_(^{tQ)xxj{to)^} .  (A. 308) 


To  obtain  this  covariance,  the  vector  Xq  is  partitioned  into  five  vectors  corresponding  to 
the  partitions  shown  in  Table  3.5  using  the  following  notation: 


(A.309) 

(A.310) 


A 

<^Pa/ 

—M.pv 

r 

A 

8pj 

^TR.pv 

Svj- 

'  ^Ta.c 

A 

= 

^O.z,c 

(A.311) 


With  this  notation,  an  expression  is  obtained  for  at  to'. 


Lci^o)  — 


l-TR.pvito) 

S-gito) 

Ldiio) 


(A.312) 


Qdim{£  Yj}  X6 


n 

,pv 

06x6 

Q6xdjm{xj^y) 

^6x6 

CL^lC—,\f,pv 

dim{x  Yf } 

Qexe 

£,v/(^o) 

^TR.pvi^o) 


(A.313) 


=  C 


£a/(^o) 


^  '  ^TR.pv(lo) 

These  equations  contains  four  transformation  matrices: 


(A.314) 


•  C.,u,pv  transforms  the  M  INS  error  vector  (x,v/)  into  the  errors  in  M  INS  indicated 
f)osition  and  velocity 


•  C,,i  transforms  the  errors  in  M  INS  indicated  position  and  velocity  into  the  contri¬ 
bution  of  these  errors  to  the  guidance  errors  (Xg) 

•  LE,2  transforms  the  tracking  <’rrors  (xjfjp^.)  into  the  contribution  of  these  errors  to 
the  guidanci'  ('rrors 
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•  CLg  Equation  A.314  is  defined  to  be  equal  to  the  partitioned  matrix  in  Equa¬ 
tion  A. 313  (as  evident  from  Equations  A. 313  and  A.314). 


Equations  A. 313  and  A.314  show  that  the  initial  covariance  of  the  guidance  state 
vector  Xq  is  given  by 

}  X  6 

Qcxdimtx,,}  I^TR.pvi^o) 


PxAto)  =  a, 


ci 


(A.315) 


where  P_\f{to)  is  the  covariance  of  the  M  INS  state  vector  and  P.TR.pv(^o)  is  the  covariance 
of  the  tracking  filter  position  and  velocity  errors  given  by  Equation  A. 375.  A  procedure 
for  computing  RcAto)  is  given  below. 

Procedure  for  computing  ficih})  —  The  top-level  procedure  for  computing  P^yito)  has 
five  steps  as  follows: 


1.  Compute 

2.  Compute 

3.  Compute  C_g2 

4.  Compute 


5.  Compute  Rai^o)  ■ 

Details  of  these  steps  are  given  in  the  following  paragraphs. 

Computation  of  —  The  6  x  dim{xn{}  matrix  is  given  in  Figure  A. 6. 


■  0 

0 

0 

0 

0 

0 

0 

L 

0 

0 

0 

0 

0 

0 

—  jR^^^sin  L 

cos  L 

(  cos  L 

Q3X  (dim{Xj^l }  -9) 

0 

0 

0 

0 

0 

0 

0 

0 

-1 

0 

0 

0 

0 

0 

0 

0 

EJL 

Rt^ 

0 

0 

0 

0 

/?0  cos  L 

0 

—  ve  tan  L 

0 

m 

Rq, 

Qb  X  (dim{r^\f  }  —  9) 

.  0 

0 

0 

0 

0 

-1 

0 

0 

0 

Computation  of  CRi 
matrices. 


Figure  A. 6:  Matrix  C_M^pu 

-  The  4  X  ()  matrix  can  be  partitioned  into  four  1  x  6  row 


CLg\ 


Cn 

Cl  3 

Ch 


(A.316) 
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where; 


Cl2 

£i3 

Q.\A 


9£.M,pv 

dSai^i^c 

^S-M.pv 

^S-M.pv 

dSa^c 


and 


North  East 

=  8a 


Expressions  for  the  row  matrices  C,,,  i  =  1,...,4,  are  given  in  Figures  A. 7 
Expressions  for  the  partials  appearing  in  these  figures  are  given  in  Tables  A.  11 
The  notation  used  in  all  these  figures  and  tables  is  summarized  in  Table  A. 10. 


[  ^’•a.e  I  '^Tg.c  ^Tg.c  ^Tg.e  j 

[  9rM0  ^VMQ  '^ZMO  I  SvMiO  J 

Figure  .A. 7:  Row  Matrix 


dat  dai ,  55/  ,  Oai , 

cio — ^  a,^ — ^  «r 

9xmo  '  dysto  d^Mo 


dvt 


(  ^Si  c  _  Bai  c 

V  '  dVMyO  Vm  )  dvsi. 


Figure  A.S:  Row  Matrix  C12 


n  c  »n,c  ,  „  ^at.c  ^ 

^9xmo  ^dyMO  ^  9xmo  \  ^  K\f  J  ^  ^v/nuo  ^ 


■  dv\fjo 


Figure  A. 9:  Row  Matrix  C13 

Computation  of  —  The  4x6  matrix  C_g2  can  be  partitioned  into  four  1 


matrices. 


Cg-,  = 


£2. 
£22 
£23 
£24  J 


(A.317) 

(A.318) 

(A.319) 

(A.320) 

(A.321) 

to  A. 10. 
to  A. 15. 


X  6  row 

(A. 322) 
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Figure  A. 10:  Row  Matrix 

Table  A. 10:  NOTATION  FOR  GUIDANCE  PARTIAL  DERIVATIVES 

[^MO  Umo  ~a/o]^  =  Pa/(^o) 

[^To  Pro  ~ro]^  =  Pt(^o) 

[^AfxO  ^MyQ  ^Afzo] 

[vTiO  ^TyO  =  V^{to) 

Aio  =  a^A-ro  —  aTo 

^Vo  =  Umo  —  Pro 

A^o  —  ^ MO  ~  ^TO 
AUxO  —  ^MxO  ^TiO 
AUyO  =  ^^AfyO  —  f’TyO 
AU;0  =  ^'A/jO  ■"  VTzO 

a,  =-^ 

02  = 

di  Given  in  Equations  A. 288  and  A. 289 
Vm  :  Given  in  Equation  A. 287 


Table  A. 11;  PARTIAL  DERIVATIVES  OF  r,,,  FOR  ua/xo  ^  0 


For  7  —  xmq,  Vmo,  ~mo^  ^MxOi  va/j,o,  -^toi  J/to)  ^toi  ^Tio,  vryo,  vtzo- 


dra,c  _  _!^9Dr.  1  1  dNr 

d'y  d-y  Dr 


Nr  —  Axq  +  Ayo  +  te  +  ■■-^At;yo  Auyo  ~  Au^o 


a/Vr  _  '-’A/yO 
dVMO  I'MiO 


=  0 

3yMo 


1^  =  0 

C#5M0 


^  =  -^Ay„  +  f.  [l-P^Au, 

^MiO  L  ''MiO 


dDj^  Q 

9zmo 


=  ^At;yo  -  1 


^Nz-  r=  -!-A(/o  +  t,  [^JlMyo.-^Tyo 

OVMyO  VMxO  ^  [  VM2O 


*-'Tyo) 


a.v. 

9x7-0 

dNr 

^MyO 

dyro 

^MxO 

dNr 

0 

il 

dzTo 

dNr 

=  -te 

d^TxO 

dNr 

dvTyO 

_  ji  I'MyO 

dNr 

dvTxO 

=  0 

^  =  0 
dXTO  ^ 


dPr  _  '^MyO 

9wTyO  I’MiO 

_9Dx_  Q 
a«Tzo  ^ 
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Table  A.  13;  PARTIAL  DERIVATIVES  OF  a,,,  FOR  t-.Wyo  0 


For  7  -  xmo,  2/mo,  ^mq,  ^^Mio, 

^'Mj/0)  ^A/zOi 

•CTO,  2/TO,  ~T0,  CTxO,  C’TyO,  ^TzO^ 

dat.c  _ 

^a,l  ^Oa,t  1 

1  dN,j 

d-y  ~ 

Da.l  dy 

Na.,1  —  Axo  +  (<e  +  Ta,c)  AUxO 


L>a,/  =  -ai{teTa,c  + 
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Table  A.  15:  PARTIAL  DERIVATIVES  OF 


For  ~i  —  x\fo,  yxfo,  zmo,  vmxo,  I’Myo,  I'Mzo,  -Pro,  Vto,  -to,  I’Tro,  L>Tyo,  ^Tzo'- 

da^  _  Nj_d^  ,  1 

a-y  —  Di  a-y  D.  a-y 

—  -^^0  +  (^e  +  ^a.cj^^zO 

Dx  =  -(<eTa.c-  + 

aN,.  _  ar„,, 

OVAfO  *  C'VMO 

9^!  -  1 

da  MO 

dN,  _  A 

QvmzO  ^^"'^dvMxO 

dNx  _  A,. 
dVMyO 

-  <  +  r 
avA/zo  '  ^  ‘^■‘= 

_a^  (/  +  r  1 

axMo  '  ^  '  ^•‘^^axMo 

9Dj^  —  (f  -L  r-  )2l2zl. 

dvMo  '  ^  “■'■'ayA/o 

^  =0 
azA/o 

_3Dj_  _  //  1  _  \  azac 

9vmj0  '  '  “•‘^'^avAJiO 

dVMyO  ~  ’’“•^^avMyO 

r^  =  o 

axro  dxTo 

dNr  _  A...  ai-o-c 

ayro  ayro 

-  1 

dzTo 

dN.  _  A..  9t^.c 

dvTio  avTio 

aN.  _  A,,  d'Ta.c 

dvTyO  ^^9vry0 

dvTzO  ~ 

'?Rt  —  (/  +  r 

t^Xxo  '  ^  *^'^'9x7'o 

aP;  _  (f  A.  r  '1^’’“  '^ 

ayro  '  ^  “'‘^'ayT'o 

If"  =  0 

aP;  =  (t  +  T  1-2^^ 

avT.0  '  '  '  '^■^fdvTxO 

aPj  —  (/  _|.  7-  )  aia.c, 

aVTyO  ~  ^  '  ^’<^)dvTyO 

.9Dj_  _  g 
dvTzQ 
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where: 


II 

01 

dSr^.c 

^^TRypv 

(A.323) 

C_22  = 

^^TR.pv 

(A.324) 

C23  — 

dxTR.pv 

(A.325) 

Cjia  — 

dSa,c 

^^TR.pv 

(A.326) 

Expressions  for  the  row  matrices  C_2,,  i  —  are  given  in  Figures  A. 11  to  A. 14. 

Expressions  for  the  partials  appearing  in  these  figures  are  given  in  Tables  A.  11  to  A.  15. 
The  notation  used  in  all  these  figures  and  tables  is  summarized  in  Table  A.  10. 

r  llshl  '21^  I  C  I 

[  dXTO  Oyro  9zto  I  HvTxO  ‘J'-'TyO  ^>'VTzO  ! 

Figure  A. 11:  Row  Matrix  C2] 


dS-i,c 
■  aiTo 


^ai.c 

3yro  *  Szro 


9ai.c 

BvtiO 


Oi 


3a|.c 

dvTyO 


Cl 


9°l.c 


Figure  A. 12:  Row  Matrix  C22 


<9«i.f  '9a(  c  dai  c 


SxTo  SzTo 


<951  _c 


t'TjO 


«2 


Sate 

dvTyO 


(12: 


9aix 

''■'TzO 


Figure  A.  13:  Row  Matrix  C23 

Computation  of  —  The  matrix  C_g  is  computed  from  its  definition  in  Equations  A. 313 
and  A. 314. 

Computation  of  /^(fo)  —  The  matrix  Pa{to)  is  computed  from  Equation  A. 315. 

A. 9. 9  Propagate  Pq 

Background  —  The  fifth  step  in  the  guidance  algorithm  is  the  propagation  from  to  to  tuo 
of  the  covariance  {P_q)  of  the  guidance  state  vector.  This  propagation  is  specified  by  the 
initial  covariance  matrix  Rdto)  (defined  in  the  previous  subsection)  and  by  the  matrices 
F_q  and  associated  with  the  state  equation 


to  —  Ex;  £.g  +  "iG 


(A.327j 
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rlo,  aOi.r  Oag  e 

•^az.c 

dxTO  -hj-ro  ''>JTO 

•'>VTiO 

''•JTi/O 

•^tlTzO 

Figure*  A. 14:  Row  Matrix  C-24 


Equations  for  and  follow. 

Computation  of  The  matrix  F^;  is  defined  in  Figure  A. 15.  The  figure  shows  that 
the  partitions  of  the  guidance  state  vector  (given  in  Equation  .A. .3 12)  propagate  as 
follows: 


Em 

0dini{r  ^j}  xti 

}  X  4 

}  x6 

Qi6x 

]+22) 

Eam 

QexS 

0^x6 

Q«X4 

Ei  . 

Figure  A.  15:  Matrix 


•  4L,vr(0  propagates  according  to  the  dynamics  of  the  M  INS  state  equation  as  de¬ 
scribed  in  Section  A. 4 

•  41iV/,pv(0  propagates  according  to  the  state  equation 

£M.pv=(i«  (A.328) 

because  £,v/,p,;(0  contains  the  M  INS  position  and  velocity  read-out  errors  at  Iq  which 

remain  invariant  with  time 

•  Similarly,  propagates  according  to 

■LTR.PV  =  Qfi  (A.329) 

because  the  tracking  errors  at  /q  ^rre  also  time-invariant 

•  Also  time-invariant  are  the  errors  in  the  computed  acceleration  and  acceleration 
interval: 

4  =  a,-  (A.330) 

•  The  errors  in  ‘‘pointing’’  the  computed  acceleration  (resulting  from  the  erroneous 
attitude  read-out  of  the  M  INS)  propagate  according  to  the  slate  equation 

kd  =  L-d  id  +  Ejm  ■  (A. 331) 
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In  this  equation: 


Ld 

^PM,L4 


^P\t,L,d 


(A.'’32) 


Perturbation  in  the  M  Location  (NED  position)  due  to 
M  INS  attitude  errors 

^VMx.d  —  Perturbation  in  the  M  velocity  (NED)  due  to  M  INS 
attitude  errors 


Ed  = 

1 

Qsxs 

0.3x3 

/.3x3 

03x3 

(position  is  the 

!^3xdim{r 

E^m  — 

0 

.  d;,y,c 

0 

Qsx  (dimIx  } 

1 

;A.334) 


(attitude  error  times  acceleration  drives  velocity  rates). 

Computation  of  The  only  entries  of  Iq  driven  by  white  noise  are  some  of  th  ' 
states  corresponding  to  the  M  INS  error  vector.  Consequently, 


Q^  = 


Say  )  x22 

ti22xdinuX(^j} 


Q.97y  Himj  X  .  .  I  (122X22 


(A.  335) 


where  is  as  described  in  Section  kA. 


A. 9. 10  Compute  M  Location  Covariance 

The  sixth  step  in  the  guidance  algorithm  is  the  computation  of  the  AI  position  and  veiocitv 
covariance  at  handover. 


=  E{ 


^P\f.L([no) 

^Pm.l{*ho) 

Evm.lC^ho) 

(A.336) 


This  covariance  is  one  of  the  four  main  results  computed  in  the  sim.ulation:  it  characterizes 
the  M  position  (^pmx)  ^nd  velocity  deviations  from  the  mean  at  handover. 

The  M  position  and  wlocity  covariance  at  handover  is  computed  by  the  transformation 


E-M.L.pv  -  (lM.L.pvPr,(fHo)Clj  i^p^,  (.4.337) 

where  P_r,{tHo)  E  calculated  as  described  in  the  previous  subsection.  The  transformation 
C.M.L,pv  ‘s  defined  in  Figure  .A.  16. 

^®The  other  three  main  results  computed  by  the  simulation  are:  the  T  position  and  velocity  covariance 
at  handover  (considered  in  Subsection  A. 9. 11),  and  the  mean  M  and  T  positions  and  velocities  also  at 
handover  (considered  in  Subsection  A. 9. 6). 
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h.v/(fo)  + 

2  a,c 

0 

0 

0 

if-* 

2 

0 

o  o 

1-3x3 

Qdxa 

T'a.c 

0 

0 

dc 

0 

^a,c 

0 

Qaxs 

L3x3 

0 

0 

Figure  A.  16:  Matrix  C_xfx.pv 

Discussion  of  Equation  A.337  —  From  Equation  A. 337  and  Figure  A.  16  the  following 
expression  is  obtained  for  the  deviation  in  M  position  from  the  mean  at  handover: 

^PM.iihio)  =  ^■^a.c  t’A/(io)  +  +  ^PM.L,d{^Ho)  (A. 338) 

The  terms  in  the  right-side  of  this  equation  are  as  follows: 

•  fitid  Tj,c  <5r,,cdc  represent  the  effect  of  integrating  the  velocity  at  to  ^.nd 
the  acceleration  applied  through  an  interval  that  is  in  error  by  STa,c 

•  represents  the  effect  of  errors  in  the  computed  acceleration 

•  ^PM,L.d  represents  the  effect  of  M  INS  attitude  errors  on  the  application  of  the 
computed  acceleration. 

Similarly,  the  following  expression  is  obtained  for  the  deviation  in  M  velocity  from  the 
mean  at  handover: 


Sv^rxiino)  =  HO  )  (A.339) 

The  terms  in  the  right-side  of  this  equation  are  as  follows: 

•  o.r  represent  the  effect  of  integrating  the  acceleration  applied  through  an  interval 
that  is  in  error  by  <5r^,c 

•  represents  the  effect  of  errors  in  the  computed  acceleration 

•  represents  the  effect  of  M  INS  attitude  errors  on  the  application  of  the 
computed  acceleration. 


A. 9. 11  Compute  T  Location  Covariance 

The  seventh  step  in  the  guidance  algorithm  is  the  computation  of  the  T  position  and 
velocity  covariance  at  handover, 


Pt.l^pMho)  =  P{ 


^PT.iAhm)  ]  [  ^Pt,l{{ho) 
^^■t.lAho)  j  L  'xJT.iihio) 


(A.340) 
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This  covariance  is  one  of  the  four  main  results  computed  in  the  simulation:  it  characterizes 
the  T  position  velocity  (ivf  i)  deviations  from  the  mean  at  handover. 

PjT.L.pvi^Ho)  is  computed  from  the  Singer  covariance  {P.ji[iHo)  in  Equation  .4.10  of 
Subsection  A. 1.2): 

Hr.L.pv  =  (Ir.L.pvRT.L(^Ho)CLT.L.pv  (A. 341) 

where  the  transformation  Ct.l  is  defined  in  Figure  .4.17,  The  figure  shows  how  the 
transformation  chooses  the  appropriate  position  and  velocity  entries  from  the  Singer  state 
vector  defined  in  Subsection  .4.1.2. 
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Figure  .4.17:  Matrix  C.T,L.pv 


A.  10  SP  Radar  Model 

A. 10.1  Background 

This  section  presents  a  back-of-the-envelope  radar  accuracy  model  for  an  airborne  surveil¬ 
lance  platform  such  as  the  E-3  AVVACS.  The  model  is  “back-of-the-envelope''  because  all 
accuracies  are  characterized  by  simple  one-line  formulas.  A  more  detailed  accuracy  char¬ 
acterization  can  be  developed  but  is  beyond  the  scof  of  the  present  study.  While  the 
model  is  addressed  to  airborne  early-warning  radars  such  as  that  aboard  the  .4WACS 
surveillance  platform,  the  model  is  completely  based  on  unclassified  information. 

.411  radar  measurement  accuracies  (range,  azimuth,  elevation,  and  range-rate)  can 
be  characterized  as  the  root-sum-square  of  a  range-dependent  (RD)  term  and  a  range- 
independent  (RI)  term: 

<7total  =  t/'^RD  +  (A. 342) 

The  RI  term  characterizes  the  physical  limits  of  the  radar:  no  matter  how  close  the  target 
is  to  the  radar,  the  measurement  accuracy  is  corrupted  by  factors  such  as  vibration, 
deformation  of  the  air  frame.  re.solver  accuracy,  etc.  The  RD  term  represents  the  effect 
of  signal-to-noise  ratio  (.S.NR)  on  the  measurement  accuracy: 

•  Accuracy  improves  with  a  stronger  received  signal  power  level  (such  as  results  from 
a  larger  target,  a  shorter  distance  to  the  target,  or  a  more  powerful  radar) 

•  Accuracy  deteriorates  from  a  stronger  noise  power  level  (such  as  results  from  less 
expensive  radar  ef|uipment  or  from  the  presence  of  jamming). 
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In  Subsection  A.  10.3  expressions  are  given  for  both  the  RD  and  RI  accuracies.  These 
expressions  are  based  on  the  assumptions  listed  in  Subsection  .4.10.2. 

A. 10. 2  Assumptions 

Model  assumptions  are  divided  into  three  categories:  fundamental  assumptions,  radar 
parameter  assumptions,  and  miscellaneous  assumptions. 

Fundamental  Assumptions: 

•  All  RD  accuracies  (range,  range-rate,  azimuth,  and  elevation  accuracies)  are  ex¬ 

pressed  in  terms  of  the  azimuth  accuracy  (standard  deviation  of  error)  under  nom¬ 
inal  conditions,  he.,  the  ‘‘quality”  of  the  radar  is  parameterized  by 

A  typical  value  of  (Tnrtn,  is 

^RD.a^  -  1  deg.  (A.343) 

To  consider  radars  which  are  “better”,  values  of  ctJ^d  smaller  than  1.5  deg  are 
assumed:  and  convcisely  for  "worse"  radars 

•  iVominai  conditions  are  defined  as  follows: 

-  Range  to  the  target  is  300  km 

-  The  target  has  RCS  of  1  m*  (corresponding  to  a  typical  fighter  aircraft^®) 

-  The  radar  has  parameters  as  listed  below. 

Radar  Parameter  .Assumptions:  The  following  assumptions  are  based  on  the  parame¬ 
ters  of  the  AWACS  E3  surveillance  radar  as  reported  in  the  unclassified  literature  ([Morchin, 
1990]): 


A  =  Wavelength 
=  10  cm  (S-band) 

(A.344) 

=  Horizontal  dimension  of  antenna 

=  7.5  m 

(A.345) 

h/  =  Vertical  dimension  of  antenna 

=  1.5  m. 

(A.346) 

The  following  additional  assumptions  are  made: 

T  —  Compressed  pulse  width 
=  0.05  /t  sec 

(A.347) 

A/  =  Doppler  filter  bandwidth 

-  300  Hz. 

(A.348) 

Miscellaneous  assumptions: 

■^“The  radar  cross  section  (RCS)  meastircd  in  m^,  is  roughly  proportional  to  'he  size  of  the  target. 
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•  The  radar  measures  range,  range-rate,  azimuth,  and  elevation 

•  All  measurement  noises  are  uncorrelated 

•  SNR  is  proportional  to  the  RCS  (cr)  and  inverselj'  proportional  to  the  fourth  power 
of  the  distance  to  the  target  (/?),  so  that 

SNR  =  (A.349) 

The  constant  Kr  depends  on  the  transmitted  power,  system  losses,  and  ort«or  ^:>,ctorc 
,,cccrding  to  the  radar  equation  ([Skolnik,  1980]). 

•  All  RD  accuracies  (e.g.,  [Hovanessian,  1988])  are  inversely  proportional  to  SNR 
according  to  (c  is  the  speed  of  light.  .1  x  10®  m/sec): 


<^RD.R 


^RD.R 


<7RD.az 


(^RD.el 


RD  range  standard  deviation  (m) 

CT 

4\/SM 

RD  range-rate  standard  deviation  (m/sec) 
A  A/ 

Ax/SM 

RD  azimuth  standard  deviation  (deg) 

A  180 

2/,,ySNR  - 

RD  elevation  standard  deviation  (deg) 

A  180 


(A.350) 

(A.351) 

(A.352) 

(A.353) 


A. 10.3  Accuracy  Model 

The  accuracy  model  for  the  RD  component  is  given  by  the  following  equations; 


^RD.R  = 

'^RD.R  ~ 
^RD.az  = 

^RD.r.l  = 


2.23  X  10-'°  ^ 


4.46  X  10-'° 


2.22  X  10""  On 


1.11  X  I0-'°  ^ 


•  ^ 

RD,az  ^ 

.  ^ 

RD,az  ^ 


(m) 

(m/sec) 

(deg) 

(deg). 


(A.354) 

(A.355) 

(A.356) 

(A.357) 


These  equations  are  obtained  by  .solving  Equation  t\.Z^2  for  Kr  (using  Equation  A.349) 
as  a  function  of  o^q  under  nominal  conditions.  The  resulting  expression  for  SNR  is 
then  substituted  in  Equations  A.350  to  A.353  for  the  range,  range-rate,  azimuth,  and 
elevation  standard  deviations. 
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The  error  model  for  the  RI  components  are  specified  by  constant  standard  deviations: 


=  o  m  (A. 358) 

~  ^0  m/sec  (A. 359) 

CTRi.az  =  I  deg  (A. 360) 

(^RiM  =  2  deg.  (A.361) 

The  total  error  is  obtained  by  rss’ing  the  RD  and  RI  components: 

<7TOT.\L,fi  =  \J'^RD.R  ^  ^^tI,R  (A. 362) 

<^TOTAL./?  =  \/^RD.R  +  '^RRR  (A. 363) 

<7TOTAL,aj  =  sJ^RD.az  +  ^RRaz  (A.364) 

^TOTAL.ei  =  +  (A.365) 


An  example  of  the  computation  of  radar  errors  is  shown  in  Table  A. 16.  The  table  lists 
errors  under  nominal  conditions  for  =  1.5  deg. 

Table  A. 16:  RADAR  ERROR  STANDARD  DEVIATIONS  FOR  =  1-5  deg 


.MEASUREMENT 

RD  ERROR 

RI  ERROR 

TOTAL  ERROR 

Range  ( m) 

15 

5 

16 

Range- Rate  (m/sec) 

30 

10 

32 

Azimuth  (deg) 

1.5 

1 

2 

Elevation  (deg) 

_ 1:5 _ 

2 

8 

A.  11  SP  Tracking  Filter  Model 

A. 11.1  Background 


The  objective  of  the  SP  tracking  filter  model  is  the  computation  of  the  position  and 
velocity  estimation  error  covariance  matrix  at  time  to  (time  to  is  the  time  at  which  the  M 
has  achieved  its  cruising  speed.  Subsection  A. 9.4).  This  covariance  matrix  is  defined  by 


E.TR.pvi^o) 


E{ 


^PT(to) 

SpT(to) 

Surito) 

(A.366) 


where  Spj{to)  and  Svjito)  are  the  errors  in  estimating  the  target’s  unperturbecP^  position 
and  velocity  vectors  in  the  Tframe.^^ 

The  matrix  P.TR.pv(^o)  is  obtained  via  a  Kalman  update  and  a  Kalman  propagation. 
I  he  top-level  of  the  update  and  propagate  is  given  in  Subsection  A.  11. 2.  The  formulas 
for  the  matrices  which  define  the  update  and  propagate  (  Utr,  Rjr,  Ktr^  ^rid  Qjf^)  are 
given  in  Subsection  A.  11.3. 

■^’“Unperturbed”  means  without  the  Singer  perturbation  (i.e.,  the  slraigbt-linf  T  trajectory). 

■’^The  superscript  t  indicating  the  Ufrarr.e  is  omitted  in  this  section. 
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A.  11. 2  Tracking  Filter  Top  Level 

The  Kalman  update  and  propagate  procedure  leading  to  the  computation  of  Tjh,pv(^o) 
is  divided  into  four  steps  as  follows; 

•  Computation  of  the  covariance  before  the  update  (at  IZwnch'^ 

•  Computation  of  thu  rovariance  after  the  update  (at  itAUXcn) 

•  Propagation  from  t^AUNCH  ^*3 

•  Computation  of  P.TR.pAio)- 

1.  Computation  of  covariance  before  the  update  (at  '  state  vector  of  the 

tracking  filter  is  as  defined  in  Table  3.7: 


iTfi  - 


hpsp 

Svsp 

S0sP,az 

Lt 

^PTx  bias 

<5nTx  BIAS 
<5pTy  BIAS 
<5vTy  BIAS 
BIAS 
BIAS 


(A.367) 


Because  the  three  parts  of  are  uncoirelated,  the  covariance  of  the  state  vector  is  a 
block-diagonal  matri.x: 


(A.368) 

(A.369) 


Expressions  for  the  diagonal  blocks  follow. 

The  covariance  P_sp,pva  models  the  uncertainty  in  the  position,  velocity,  and  azimuth 
read-out  of  the  SP  INS.  This  covariance  is  given  by  a  transformation  of  the  covariance 
(P5P)  of  the  SP  INS, 

PsP,pva  =  (LsP.pvaE-SpGJsP,pva  (A. 370) 

where  the  is  as  shown  in  Figure  .4.18. 

The  covariance  Pfp  i  models  the  uncertainty  in  the  trajectory  of  the  T  as  given  by  the 
Singer  model  described  in  Subsection  A. 1.2.  The  covariance  is  as  defined  in  Equation  A. 10 
and  is  computed  by  propagating  the  covariance  according  to  Equation  A. 4  for  the  x- 
component  and  identical  equations  for  the  y-  and  x-components. 
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Figure  A.  18:  Matrix  Cgp^pya 


The  covariance  of  fho  bias  part  of  the  state, 


^PTx  bias 
^VTx  bias 

Spry  BIAS 
i^VTy  BIAS 
SpTz  BIAS 
.  ^I'TzBIAS  . 


(A.371) 


represent  the  uncertainty  in  the  location  of  the  straight-line  trajectory  of  the  target  before 
the  radar  measurement  is  processed.  Because  this  uncertainty  is  "infinite"  (T  trajectory 
is  unknown),  the  covariance  is  a  diagonal  matrix  with  large  diagonal  entries: 


-T,6 


(100km)2  0  0 

0  (300m/sec)^  0 

0  0  (100km)2 

0  0  0 

0  0  0 

0  0  0 


0  0  O' 

0  0  0 

0  0  0 

(300m/sec)^  0  0 

0  (100km)2  0 

0  0  (OOOm/sec)*^ 

(A.372) 


2.  Computation  of  covariance  after  the  update  (at  ttAUN’Cfl)-  covariance  after 
the  update,  i^r/?(^LAUNCH)-  obtained  by  performing  a  Kalman  update  on  the  covariance 
£th(^launch)-  The  Kalman  update  is  specified  by  the  matrices  H-pp  and  Epp  defined  in 
Subsection  A. 11.3.  These  matrices  model  the  linearized  measurement  equation 


£t/?  —  U-trUtii  +  ilTfi 


(A.373) 
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where  the  vector  Zj-fi  is  the  measurement  of  errors  in  range,  range-rate,  azimuth,  and 
elevation,  and  all  quantities  are  evaluated  at  ^L.4mvc//- 

3.  Propagation  from  ti,AUi\'CH  ^o-  The  covariance  £-/■/?( ^launch)  propagated  from 
tiAU.xcH  ^0  according  to  the  state  equations 


trR  —  i-TR  iTR  +  li-TR 


(A.374) 


This  propagation  is  defined  by  the  dynamics  matrix  F_jfi  and  the  white  noise  spectral 
density  matrix  ([Gelb,  1974]).  Expressions  for  these  matrices  are  provided  in  Sub¬ 

section  .A.  11. 3.  The  propagation  produces  P.rRi^o)- 

4-  Computation  of  P.rR,pvi^o):  The  matrix  RjR.pviio)-,  defined  by  Equation  A. 366,  is 
obt  ained  trom  P.jft{to)  by  the  transformation 


Ri  R.pv'Co)  —  Crfl£r/?(fo)CTfi. 


(A.375) 


where 


1 

0 

0 

0 

0 

0  ■ 

^3x16 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

1 

0 

0 

1 

0 

0 

0 

0 

Sbxie 

0 

0 

0 

1 

0 

0 

0 

0 

0 

0 

0 

1 . 

(A.376) 


The  transformation  Cj/j  includes  only  the  errors  in  estimating  the  bias  states  because 
the  M  guidance  computations  are  based  on  the  straight-line  unperturbed  T  trajectory, 
excluding  the  short-term  Singer  perturbations.  The  bias  states,  however,  are  observed  in 
the  presence  of  the  Singer  perturbations  as  modeled  by  the  f£jp{  matrix  defined  below. 


A.  11. 3  Computation  of  R-pn  E.tr’,  and 

Matrix  The  matrix  U_tr  appearing  in  the  linearized  measurement  equation  (Equa¬ 

tion  .A. 373)  has  four  rows  corresponding  to  the  four  radar  measurements: 


\£Lx  1 

K2 

th 

[tUi 


In  this  equation,  the  fj_,  are  1  x  22  row  matrices: 


fix  = 

IL2  = 


OR 

ff^TR 

OR 

ff^TR 

da 

ff^TR 

be 

l^TR 


(A.377) 


(A.378) 

(A.379) 


(A. 380) 
(A.381) 
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=  True  rangt- 
=  True  range-rate 
a  =  True  azimuth 
e  =  True  elevation 

■Ltr  =  Tracking  state  vector  defined  in  Equation  A. 367. 

The  entries  in  are  given  in  Figure  A. 19  (x,  (/,  and  r  correspond  to  North.  East,  and 
Down). 

I  ('Xs  SlJs  i  I  ^(^SP.az  |  PTx  >'Tt  ^Tx  |  PTy  >'Ty  (^Ty  |  PTz  >'Tz  <^Tz 

^PTx  bias  ^I’Tx  BIAS  ^Ply  BIAS  ^*’Ty  BIAS  ^PTz  BIAS  ^*'Tz  BIAS 
Figure  .N.IO;  Entries  in  State  Vector 

Expressions  for  the  row  matrices  //,  are  given  in  Figures  A.'^O  to  ,A.23.  Expressions 
for  the  partials  appearing  in  these  figures  are  given  in  Tables  A. 17  to  A. 20.  All  quantities 
appearing  in  these  figures  and  tables  are  evaluated  at  the  update  time.  Iiaunch- 


r  dR  r.R 

.  J  . 


0  0  0  I  0 


_  0  _  0  —  0 

'^'iPTx  BIAS  ''^*PTy  BIAS  ■■'*PT2BIAS 


Figure  .A. 20:  Row  .Matrix  //, 
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Table  A.20:  PAIITIAL  DEHIWVTIVES  OE  ^ 


.'V 

-1  >11 

‘  J  L*  X 

__  -1  .-r---.-  >11 

v/i-p'  Oy-s 

'  ir 

—  -i  .'/(  j  i] 

yrr-i  /e-  ecc  h] 

V 

■*f=-  —  1  C  J-  —  *  C  ■  f /■? 

aP7'r 

~  blA.i  ~  /t-  -‘'Pri 

V  “  ' 

■  ip 

.V  -1  3,----  ‘fi 

•'VTy 

■l*PTy  ljIA,S  y/T-rH  'PCs, 

:ip 

—  I  j  ’7 - '  '  ■*/?  1  1 

■-*PTz 

■'‘‘'PTz  BIAS  'PP"  ^^1 

where  g  = 

where  the  standard  deviations  along  the  diagonal  are  given  in  Equations  A. 362  to  A. 365 
of  Section  A.  10.  These  standard  deviations  are  assumed  to  be  indicative  of  both  mf.asure- 
meiit  accuracy  (i.e..  the  accuracy  of  the  measuremenl  made  during  one  scan)  and  tracking 
accuracy,  riiis  simplifying  assumption  is  ba.sed  on  the  uncertainty  introduced  by  target 
motion  from  scan  to  scan. 

.\fat  ni  E.TH'  The  /'’-matrix  for  propagating  the  state  (defined  in  Equation  A. 367) 
IS  shown  in  Eigure  A. 21.  The  figure  shows  that:  the  first  part  of  is  time-invariant: 
the  second  i)art  pro])agates  according  to  tlie  Singer  flynamics  (Equations  .\.2  and  A. 3); 
and  the  tliird  [lart  propagates  according  to  "position  is  the  integral  of  velocity". 

Matrix  Qjpf-  file  matrix  Qjf^  is  shown  in  Figure  .A. 25.  I’his  matrix  is  zero  except 
for  the  terms  driving  the  Singer  states  vvhich  have  entries  Qtx-  Qxy-  mid  Qt:  defined  by 
fhjuation  .A. 5. 
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Qaxe 

0  10  0  0  0 

0  0  0  0  0  0 

0  0  0  10  0 

Q«xi6  0  0  0  0  0  0 

0  0  0  0  0  1 

0  0  0  0  0  0 

Figure  A. 24:  Matrix 


Figure  A. 25:  Matrix 
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Appendix  B 

GENERALIZED  INS 
FULL-ORDER  MODEL 


[Britting,  1971]  develops  the  notion  of  a  “generalized”  INS  error  model  which  applies, 
with  only  minor  modifications,  to  all  INS  mechanizations,  hollowing  this  development, 
error  equations  for  both  strapdown  (M  and  LP)  and  local  level  (SP)  mechanizations  are 
given  in  this  section.  The  error  equations  are  represented  in  the  state-space  form 


n 

r£n 

En. 

£na 

£n.  ] 

n 

■  ULn  ■ 

d 

0 

0 

0 

+ 

IV, 

dt 

Q. 

0 

Q 

0 

ql 

Wc 

.  . 

0 

0 

0 

Fk  . 

> 

The  components  of  the  state  vector  in  this  equation  corresponds  to  the  state  variables 
listed  in  Tables  3.4,  3.6.  and  3.8  as  follows.  The  vector  n  corresponds  to  the  first  nine 
entries  on  these  tables:  attitude  errors,  position  rate,  and  position.  The  vectors  £  and  a 
and  the  scalar  dh,\  correspond  to  gyro,  accelerometer,  and  altimeter  errors  also  listed  in 
the  tables.  The  structure  of  the  state  equation  represents  the  effect  of  instrument  errors 
(c.  o.  and  Sh\)  feerJing  the  navigation  states  (u). 

The  interaction  between  the  navigation  states  and  the  instrument  errors  is  specified 
by  the  blocks  in  the  F-matrix.  The  following  paragraphs  describe  these  blocks  and  the 
white  noise  vectors  (i£„,  ic^,  w^,  and  w^^)  based  on  the  development  presented  in  [Britting, 
1971]  and  [Schmidt.  1978]. 

B.l  Matrix  F„ 

The  matrix  F,^  is  defined  in  P’igure  B.l.  This  matrix  can  be  used  to  model  any  Schuler- 
tuned  mechanization  and  con.sequently  is  applicable  to  both  the  strapdown  and  platform 
error  models.  I'he  nomenclature  used  ni  Figure  B.i  is: 

lip  —  Distance  from  the  center  of  the  Earth  to  the  vehicle 

=  Ra,  +  h 

Ila,  =  Radius  of  a  spherical  Earth  (6378  km) 
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Angular  velocity  of  the  Earth 
Latitude 

Celestial  longitude  (relative  to  the  vernal  equinox) 
Terrestrial  longitude  (relative  to  Greenwich) 

Altitude 

Output  of  an  accelerometer  pointing  North  (specific  force) 
Output  of  an  accelerometer  pointing  East  (specific  force) 
Output  of  an  accelerometer  pointing  Down  (specific  force) 
Gains  for  2ncl  order  altimeter  loop 
Schuler  frequency  {^Jg! Rp) 

(davity  acceleration  at  the  location  of  the  vehicle. 


The  first  three  rows  of  (Figure  B.  I )  describe  the  dynamics  of  the  errors  in  estimating 
the  orientation  of  the  platform  relative  to  the  local-level  frame.  These  errors  are  produced 
by  gyro  errors  introduced  into  the  differential  equation  by  the  term  in  Equation  B.l. 

The  middle  three  rows  characterize  how  accelerometers  errors  in  Equation  B.l)  and 

attitude  errors  lead  to  errors  in  the  estimated  velocities  (latitude  rate,  longitude  rate,  and 
altitude  rate).  The  bottom  three  rows  represent  the  integration  of  latitude  rate,  longitude 
rate,  and  altitude  rate  to  obtain  latitude,  longitude,  and  altitude. 

B.2  Matrix  F.  and  Vector  Wc 

The  matrix  F,  and  vector  ic,  in  Equation  B.l  specify  the  state  equations 

(B.2) 

for  the  vector  of  gyro  errors  c.  Each  of  the  entries  in  the  vector  £  models  an  error  source 
for  one  of  the  three  gyros  ( j.  y,  or  c)  of  the  1NS.‘  The  error  sources  can  be  classified  into 
three  groups  as  summarized  in  the  first  two  columns  of  Table  B.l: 

•  Gyro  drift  rate  (top  part  of  the  table),  a  result  of  random  drift  of  the  gyro  output 
axis 

•  Scale  factor  errors  (middle  part),  a  result  of  gyro  torquer  inaccuracies 

•  .Misalignment  errors  (bottom  part),  a  result  of  inaccuracies  in  mounting  the  gyros 
on  the  INS. 

.As  indicated  in  the  third  column  of  the  table,  each  error  source  in  e  is  modeled  by  either 
a  bias,  a  first-order  Markov,  or  a  random  walk,  depending  on  the  error  source  group.  The 
parameters  of  these  models  define  the  entries  in  the  matrix  and  the  vector  ([Gelb, 
1974]).  Parameters  assumed  for  the  M.  LP,  and  SP  gyros  are  given  in  Sections  A. 4,  A. 5, 
and  A. 6. 

'For  a  platform  INS,  x  =North,  j/=Ea.st,  and  z  =Down.  For  a  strapdown  mechanization,  x  =Roll. 
y  =Pitch,  and  z  =Yaw. 
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Table  B.l:  COMPONENTS  OF  THE  (;\  RO  ERROR  VECTOR.  £ 


SYMBOL 

DEFINITION 

MODEL  TYPE 

x-gyro  drift  rate 

Bias,  R.W..  .Markov 

y-gyro  drift  rate 

^.7 

c-gyro  drift  rate 

c 

x-gyro  scale  factor  error 

Bias,  Markov 

c 

y-gyro  scale  factor  error 

t: 

r-gyro  scale  factor  error 

Ory 

x-gyro  misalignment  resulting  from  a  rotation  about  y-axis 

Bias 

Ori 

x-gyro  misalignment  resulting  from  a  rotation  about  r-axis 

Oyr 

y-gyro  misalignment  resulting  from  a  rotation  about  x-axis 

0,j, 

y-gyro  misalignment  resulting  from  a  rotation  about  ;-axis 

0;r 

c-gyro  misalignment  resulting  from  a  rotation  about  x-axis 

r-gy'ro  misalignment  resulting  fro.m  a  rotation  about  y-axis 

B.3  Matrix  and  Vector 

Tlie  matrix  and  vector  iv^  specify  the  state  equations 

SI  =  E^Q.  +  ULc  (B.3) 

for  the  vector  of  acceleration,  a.  The  entries  in  this  vector  include  three  groups  analogous 
to  those  of  the  gyro  errors  (random  acceleration  error,  scale  factor  error,  and  misalign¬ 
ments)  as  shown  in  Table  B.2.  In  addition,  a  fourth  group  modeling  gravity  uncertainty 
errors,  is  also  included  in  the  vector  a.  Parameters  assumed  for  the  acceleration  errors 
driving  the  M.  LP.  and  SP  INSs  are  given  in  Sections  A.4,  A. 5,  and  A. 6. 

Table  B.2:  COMPONENTS  OF  THE  ACCELERATION  VECTOR,  q 


SYMBOL 

DEFINITION 

.MODEL  TYPE 

x-accelerometer  random  error 

Bias,  R.VV..  Markov 

y-accelerometer  random  error 

a. 

z-accelerometer  random  error 

n-T 

x-accelerometer  scale  factor  error 

Bias,  Markov 

y-accelerometer  scale  factor  error 

r-accelerometer  scale  factor  error 

Oxy 

x-accelerometer  misalignment  (analogous  to  4>ry  ) 

Bias 

Oiz 

x-accelerometer  misalignment  (analogous  to  <f>rz) 

Oyr 

y-accelerometer  misalignment  (analogous  to  4>yr) 

Oyz 

y-accelerometer  misalignment  (analogous  to  0^^) 

Ozr 

2-accelerometer  misalignment  (analogous  to  <}>tx) 

0,y 

2-accelerometer  misalignment  (analogous  to  (i>zy) 

n 

Vertical  deflection  about  East  axis 

Bias,  Markov 

Vertical  deflection  about  North  axis 

^9 

Gravity  anomaly 
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B.4  Scalars  F/,  and 

The  vertical  channels  of  the  three  INSs  under  consideration  are  assumed  to  be  damped 
by  an  altimeter  having  errors  characterized  by  a  first-order  Markov, 

6ka  =  Fk  Sh,\  -b  u'h  .  (B.4) 

Parameters  for  these  Markovs  are  given  in  Sections  A. 4,  A. 5.  and  A. 6. 


B.5  Matrix  F,,.- 


The  matrix  is  given  by 


F 

— p— nf  1 


Q3xdiin{ff} 


(B.5) 


L  Q3x<lim{c}  J 

The  notation  in  this  ecjuation  is  as  follows:  is  the  direction  cosine  transformation 

between  the  platform  frame^  and  the  navigation  (also  called  local-level  or  geographic) 
frame  ([Britting,  1971]);  is  a  matrix  specified  below;  and  Q3xdini{i}  the  zero  matrix 
having  the  indicated  dimension. 

Equations  B.5  and  B.l  show  that  the  effect  of  the  matrix  is  to  transform  the  vector 
of  gyro  errors,  c,  into  quantities  that  drive  the  attitude  error  states  (all  other  states  are 
not  directly  affected  as  indicated  by  the  zero  matrices).  This  transformation  is  a  two  step 
process.  First,  the  vector  s  is  multiplied  by  the  matrix  F_nei  shown  in  Figure  B.2.  This 
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Figure  B.2:  Matrix 

transformation  “adds-up”  the  gyro  errors  from  the  three  groups  (random  drift  rate,  scale 
factor,  and  misalignments)  in  each  dimension  of  the  platform  frame.  The  weights  Uj., 
u!y,  and  ui^.  multiplying  the  scale  factor  and  misalignment  errors,  are  the  angular  rates 
experienced  by  the  x,  y,  and  2  gyros. 

^For  a  strapdown  INS,  the  “platform”  frame  is  the  body  frame;  for  a  platform  INS,  it  is  the  local-level 
frame. 
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The  second  step  is  the  transformation  of  the  total  error  in  each  dimension  from  the 
platform  frame  to  the  local-level  frame  to  drive  the  attitude  states.  This  step  is  imple¬ 
mented  with  the  direction  cosine  matrix  which  is  defined  by  ([Farrell,  1976]) 


In 

■  jp 

kp 

C"  = 

— p 

Jn 

■ 

Jn 

■  jp 

Jn 

•?P 

*  Ip 

■Jp 

L 

■4 

In  this  equation  and  {ip.jp.kp)  are  unit  vectors  along  the  n  and  p  frames,  and 

indicates  the  dot  product.  The  formulas  tor  computing  C”  are  as  follows: 


•  For  the  SP  (in  fact,  for  any  local-level  INS),  the  p  frame  is  the  n  frame  so  that 


—p 


=  /. 


(B.7) 


•  For  the  LP,  is  computed  from  the  assumed  trajectory  as  given  in  Section  A. 3 

•  For  the  M,  C"  is  computed  from  the  guidance  commands  using  the  formulas  given 
in  Section  .\.9. 


B.6  Matrix  F_na 


The  matrix  is  given  by 


F  - 

na 


Q3xdini{or} 


Qaxdimto} 

The  notation  in  this  equation  is  as  follows.  The  matrix  D,  given  by 


D  = 


i  0  0 


0 


0 


Rp  cos  L 
0  0-1 


(B.8) 


(B.9) 


transforms  velocities  from  the  linear  scale  (uNorth)  and  Voown)  fo  an  angular  rates 

scales  (latitude,  longitude,  and  altitude  rates).  The  direction  cosine  matrix  trans¬ 
forming  the  p-frame  to  the  n-frame,  is  as  defined  in  Equation  B.6.  The  matrices  F^^i 
and  Fna2  are  defined  below. 

Equations  B.8  and  B.l  show  that  the  effect  of  the  matrix  Fna  is  to  transform  the  vector 
of  acceleration  and  gravity  errors,  a,  into  quantities  that  drive  the  velocity  error  states 
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(latitude  rate  error,  longitude  rate  error,  and  altitude  rate  error).  This  transformation 
involves  the  addition  of  two  terms:  errors  due  to  acceleremoter  uncertainties  and  errors 
due  to  gravity  uncertainties. 

Errors  due  to  accelerometer  uncertainties  are  modeled  by  the  product  of  .D  CpF^^i 
times  the  first  three  parts  of  a  shown  in  Table  B.2  containing  xcelerometer  errors.  The 
matrix  shown  in  Figure  B.d.  "adds-up"  the  three  groups  of  accelerometer  errors 

(random  drift  rate,  scale  factor,  and  misalignments)  in  each  dimension  of  the  platform 
frame.  The  resulting  total  error  is  then  converted  from  the  platform  to  the  navigation 
frame  by  Cp,  and  from  the  linear  to  the  angular  rate  scale  by  JD-  The  weights  fy,  and 
f:  multiplying  the  scale  factor  and  misalignment  errors  are  the  specific  force  experienced 
by  the  .r.  y,  and  r  accelerometers. 
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Figure  B.3:  Matrix 


Errors  due  to  gravity  uncertainties  are  introduced  by  the  product  F„o2  firnes  the  last 
three  states  in  o.  The  matrix  Ena2  is  given  by 


D  = 


^  0  0 

0  0 
0  0  1 


(B.IO) 


This  matrix  models  the  effect  of  the  vertical  deflections  about  East  and  North  on  the  time 
derivatives  of  latitude  and  longitude  rates,  and  also  the  effect  of  the  gravity  anomaly  on 
altitude  acceleration  . 
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B.7  Matrix  F, 


The  matrix  E_nh  given  by 


Fih  — 


Qaxr 


(B.ii; 


0 

0 

A'l 


The  roii'^tants  A',  and  Ab  appearing  in  and  in  the  last  column  of  F„  (Figure  B.l) 
flefine  a  second-order  loop  used  to  damp  the  vertical  channel  of  the  1\S  ([Kayton.  1969] 
and  [Schmidt.  1978]).  The  transfer  function  for  this  loop  is  given  by 

—  1  I\  2 


6h{s)  = 


-f  AjS  -f  ( A2  —  -f  AjS  -f  (A2  — 


6hf 


(B.12) 


In  this  equation.  Sh{s)  is  the  altitude  error  (<5/jm  for  M.  Shs  for  SP,  or  6hi  for  LP);  Sh/i, 
is  the  altimeter  error  for  M,  ShsA  for  SP,  or  6Ala  for  LP);  Sfo  is  the  total  specific 

force  error  in  the  Down  direction;  and  I\\  and  A'2  are  the  damping  constants. 

The  remainder  of  this  subsection  is  addressed  at  the  selection  of  the  damping  constants 
A'l  and  A'2  for  the  M,  LP,  and  SP  INSs.  The  constant  A'2  is  set  to 


4  R„ 


(B.13) 


to  achieve  critical  damping  which  prevents  ‘‘ringing'’  (oscillations)  in  the  loop  response 
([Van  Valkenburg,  1964]).  For  critical  damping,  the  transfer  function  in  Equation  B.12 
becomes 


Sh(s)  = 


(i  +  .sr,)2 


4 — 


|i  +  7^1('+-'r2) 


-Shi 


where 


=  77- 


T2  = 


2 


A', 


(B.14) 

(B.15) 

(B.16) 


The  constants  Ti  and  T2  specify  the  break  frequencies  wi  and  u/2  of  the  associated  Bode 
plot  ([Van  Valkenburg,  1964]): 

1  lu 


= 


Ti 


2 
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=  !ii  +  -go 

T2  4  Rp  A 1 


(B.18) 


VVhal  remains  now  is  the  selection  of  the  constant  I\\  which  determines  the  charac¬ 
teristics  of  the  altitude  error  6h,  as  evident  from  Equations  B.14  to  B.16.  The  constant 
is  thus  set  to  achieve  a  "satisfactory”  8h  according  to  the  following  three  criteria: 

1.  Set  A]  so  that  the  loop  damps-out  errors  quickly 

2.  Minimize  the  effect  of  the  errors  introduced  by  the  accelerometer  errors,  Sfp,  via 
Equation  B.14 

3.  Minimize  the  effect  of  the  errors  introduced  by  the  altimeter  errors,  6h^,  via  Equa¬ 
tion  B.14. 


These  three  criteria  are  considered  in  the  following  three  paragraphs. 

The  response  time  of  a  critically  damped  second-order  loop,  defined  here  as  the  time 
required  for  the  step  response  to  achieve  90%  of  its  final  value,  is  given  by  r^o  =  4/lj„ 
where  u,v  is  the  natural  frequency  of  the  loop  ([Kuo,  1962]).  In  Equation  B.14  =  u-q 

.so  that 

r9o=—  (B.19) 


where  ui\  =  A'i/2.  Consequently,  to  obtain  quick  damping  of  altitude  errors  u^q  must  be 
sufficiently  large. 

The  effect  of  accelerometer  errors  (first  term  on  the  right  side  of  Equation  B.14)  can 
be  divided  into  two  components;  low-frequency  and  high-frequency  accelerometer  errors. 
High-frequency  errors  are  attenuated  by  making  a.q  as  small  as  possible.  The  effect  of 
low-frequency  errors  can  be  measured  from,  the  steady-state  altitude  error  produced  by 
the  accelerometer  bias,  which  from  the  final  value  theorem  ([Kuo.  1962])  is  given 

by 


,,  \6A  6A 


(B.20) 


where  8 A  is  the  magnitude  of  a  step  acceleration  error.  Consequently  to  obtain  a  satis¬ 
factory  low-frequency  response  to  accelerometer  errors,  u;i  must  be  made  large. 

The  effect  of  the  errors  introduced  bv  the  altimeter  (second  term  on  the  right  side  of 
Equation  B.14)  is  reduced  by  ( 1 )  making  u;i  as  small  as  possible  to  filter-out  high-frequency 
‘’rrors,  and  (2)  making  UI2  large  to  avoid  amplification  of  higher  frequency  errors  by  the 
lead  factor  of  the  second  term  in  Equation  B.14.  The  value  of  0J2,  however,  is  given  by 
(from  Equations  B.17  and  B.18) 


9o 

RpU)i 


(B.21) 


for  critical  damping.  This  equation  indicates  that  the  effect  of  altimeter  error  on  altitude 
error  is  not  a  monotonic  function  of  ui  (i.e.,  it  is  not  a  simple  matter  of  making  wi  small 
or  large). 
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Coiisequeiilly,  it  is  necessary  to  obtain  an  exact  equation  for  tlie  RMS  value  of  Sh 
produced  by  ^h.^.  Assuming  a  first-order  Markov  for  the  transfer  function  relating 
Sh  and  Sh,[  is  obtained  from  Equations  B.1-1  to  B.IG  (setting  Sfo  —  0): 


Sh 


due  to  altimeter 


22o1 

Hp  J 


a^/23 

7+1 


(B.22) 


where  a  and  3  are  the  RMS  value  and  inverse  correlation  time  of  the  Markov  process. 
From  this  transfer  function,  an  expression  for  the  RMS  value  of  Sh  is  obtained  following 
the  procedure  in  [Newton,  Could,  and  Kaiser,  1957]; 


due  to  altimeter 


+  (cj  —  2coC2)dof/,3  +  0502+3 
2dod:i{did2  —  dot/3) 


(8.23) 


The  terms  in  this  etjuation  are  giveir  by; 


C2  =  0 

Cl  =  KiOiJ^ 


dj  —  1 

t/2  =  A'l  +  3 


A' 2 

di  =  + 

4 


In  summary,  the  three  criteria  listed  above  for  a  satisfactory  vertical  channel  damping 
response  lead  to  conflicting  (large/small)  reqidrements  on  u-'i.  To  obtain  a  satisfactory 
compromise  value  for  h'l.  five  variables  were  evaluated  as  a  function  of  A' 1  using  a  program 
coded  in  the  BASIC  language; 


•  u.'i  from  Equation  B.17 


•  Tgo  from  Equation  B.19 


•  t02  from  Equation  B.18 


•  Sh,ra,  from  Equation  B.20 
®  ^6h,  due  to  altimeter  from  Equation  B,23, 

These  five  variables  were  evaluated  for  the  altimeter  and  accelerometer  error  models  of 
the  M,  LP,  and  SP  listed  in  Tables  A. 3,  A.4,  and  A,5. 

Based  on  these  calculations,  the  K\  and  K2  values  shown  in  Table  B,3  are  selected 
as  damping  constants  for  the  vertical  channels  of  the  M,  LP,  and  SP.  The  bases  of  these 
selections  are  as  follows; 
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M  INS:  (Calculations  summarized  in  Table  B.-l) 

•  Initial  vertical  channel  errors  are  damped  within  mission  time  ( =  ''0  sec) 

•  a.'i  is  small.  la'sulting  in  a  reduction  of  the  high-freciuencv  ('rrors  introduced  by 
the  low-(juality  accelerometers 

•  ^,'2  is  sufficiently  large  to  prevent  amplification  of  altimeter  errors  <iue  to  altimeter 
=  150  m) 

•  ^hssa  is  small  (5.0  rn). 

LP  INS:  (Calculations  summarized  in  laltle  H.5) 

•  Shgsa  is  negligible  (O.fi  rn). 

•  is  small.  lesidting  in  a  retiuction  of  the  high-frerpiency  acceh'rometers  t'rrors. 

•  u-'j  is  sufficiently  large  to  pi'event  arnplificat ion  of  altimr'ter  errors  aue  to  altimeter 
=  150  rn) 

SP  INS:  (Calculations  summarized  in  fable  B.b) 

•  u,'i  is  large  enough  to  make  6h„a  negligible  (0.1  rn) 

•  u,'i  is  small,  resulting  in  a  reduction  of  the  high-freciuency  turors  introduced  by 
the  low-cpiality  accelerometers 

•  u.'2  is  sufficiently  large  to  make  Uue  to  altimeter  within  5  in  of  its  minimum 
value  (which  is  obtained  for  A'l  =  0.03). 

Table  B.3:  DAMPI.XG  CO.\.ST.\.\'T.S  FOR  THE  .M.  LP.  .\.\D  SP  INS 


INS 

/m 

l\  2 

M 

0.10 

2.50  X  10-'’ 

LP 

0.08 

1.60  X  10"^ 

.SP 

0.06 

0.03  X  10-'* 

Table  B.4:  SELECTION  OF  A',  FOR  M  INS'" 


■ 

■^1 

(racl/.sec) 

m 

^^ssa 

(m) 

due  to  altimeter 

(m) 

0.001 

8000 

3.32  X  K)-^ 

0.01 

iiarigwiBa 

800 

KSiiOUiBI 

588 

165 

0.1 

80 

5.88 

151 

1.0 

0.5 

8 

0.25 

MiIiIiM 

150 

10.0 

5.0 

0,8 

2.5 

sa  0 

150 
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Pahlc  B  o:  SKLKCnON  Ol-  A',  FOR  IB’  INS' 


A'l 
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(scr ) 
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Ml 
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0 

l.aO 
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2, a 

s:  0 
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lablf  B.t.;  SFLFC  1  ION  OF  A',  FOR  SR  INS’ 


I  1 

1 

f  rad  ) 

r-M) 

( ) 

1  r.ad/s'-c) 

^  ^  Vt  <1 

(Itl) 

-iij'*  to 

(in) 

OOOl  1 

X  III-' 

■SI  Kin 

3  .32  X  in-’’ 

302 

t 

o.ood  ;  1,.') 

X  iir-’ 
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1  77  X  itr-’’ 

tt 

2.7 

I  d.Ol  1 

■'),0 

A 

.son 

2  SO  X  10-'’ 

.3 

0  06  i 

3,0 

X  10"- 

133 

1  50  X  10"- 

0.1 

6 

oil 

.5,0 

X  10"- 

Ml 

2  50  X  10"- 

2:  0 

6 

:  1.0 

0.-') 

8 

0.25 

%  0 

6 

i  10,0  ( 

5  0 

0,8 

2.5 

B.8  White  Noise  Vector,  w„ 

I  he  in  rocjiiat ion  B.l  can  he  used  to  inodc'l  the  white  noise  rontponenl  of  gyro 

drift  rate  present  in  tlie  las('r  gyros  assume*!  for  the  M  and  FR  INS,  By  thus  modeling 
t  tiis  ( ()m|)onent .  t  fir<'<’  st  at  es  are  "'aNO'd  ' .  result  inn  in  a  state  \  ('rtor  of  smaller  dimension. 

This  modeling  tc'cfmicjue  is  not  used  ni  the  mod<d  d(>serita*d  in  this  memo  because  it 
introduces  complications  ni  t  lie  sunulat  ion  of  transfer  alignnx'iit  ( ,Subs<’ct  ion  .\.S).  Con- 
secjiiently,  m  all  cases  consider('d  heie 


ti:,.  =a.  (B.2I) 

I(t  mod<‘l  the  white  noise  component  pr<‘sent  in  the  laser  gyros,  a  first-order  .Markov 
error  source  is  included  in  the  vector  £  of  Fxjuation  B.l.  The  parameters  for  this  Markov 
model  are  definecl  in  the  footnotes  t.a  Fables  .\.;»  and  A. -I  which  list  the  parameters  for 
the  M  and  LR  I.NS  error  modeds. 


'orniit ions:  .Arrelcroinctcr  hia-s  =  l.'iOl)  /ig.  .Mtimctor  ft.MS  level  =  l.'rO  ni;  .Mtimeter  Markov  corre¬ 
lation  time  =  11  min  at  ‘2  Mach  M  velocity. 

'( ’onditions:  Accelerometer  bia.s  =  100  /<g;  Altimeter  RMS  level  =  l.")0  m;  .Altimeter  Markov  correla¬ 
tion  time  =  28  mm  at  0.8  Mach  I.f’  velocity, 

’Conditions:  Accelerometer  hia.s  =  10  /eg;  .Altimeter  RMS  level  =  6  m;  Altimeter  Markov  correlation 

time  =  .10  sec 
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